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ABSTRACT 


The purpose of this thesis is to evaluate the hardvvare and softvvare for a Small 
Autonomous Underwater Vehicle (AUV) Navigation System (SANS), a self-contained, 
externally mountable navigation system. The SANS is designed to determine the location 
of an underwater object using a combination of Global Positioning System (GPS) while 
surfaced, and Inertial Navigation System (INS) while submerged. 

Various experimental testing of the hardware was performed to determine the ability 
of the GPS navigation system to function within the mission requirements. A test was done 
to determine the time required to obtain a GPS fix. A test of the system while the antenna 
was covered with water, was done to determine if the GPS signal could penetrate a shallow 
layer of water. Finally, a sea test was done to determine the feasibility of reacquiring a GPS 
fix after the system has been submerged during normal ocean wave wash. A computer 
simulation was written in Common LISP Object System (CLOS) in order to evaluate the 
errors introduced by using an accelerometer in the INS to determine the climb angle of the 
AUV while surfacing. 

The experimental testing of the GPS system showed that the GPS signal is able to 
penetrate a shallow layer of water covering the antenna, and that the system is able to meet 
the accuracy and time requirements of the mission while being splashed by wave wash. The 
simulation results show that the error introduced by measuring climb angle with an 


accelerometer is minor and will not significantly degrade the accuracy of the system. 
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I. INTRODUCTION 


A. BACKGROUND 


The mission of Autonomous Undervvater Vehicles (AUVS) varies greatly. One of 
the most important and most difficult areas of AU V research is navigation. There are many 
types and combinations of navigation that can be used by AUVs. The type of navigation 
system that is desired depends largely on its mission. The Global Positioning System (GPS) 
provides a highly accurate means of navigating while on the surface. Various types of 


Inertial Navigation Systems (INSs) can be used for underwater navigation. 


The Small AUV Navigation System (SANS) is designed for use on a variety of 
AUVs. These could include mechanical AUVs of varying sizes, humans, or marine 
mammals. The mission of the AUV eguipped with a SANS is underwater mapping. This 
mission 1s broken down into two phases. After being launched from shore or from a boat, 
the first phase of the mission is the transit phase. This would include navigating the AUV 
from the launch site to the desired mission area, and navigating back to a designated 
recovery site. The second phase of the mission is the mapping phase. This involves 


searching a designated area for objects of interest and determining their locations. 


In order to provide accurate navigation and mapping, a combination of GPS and 
INS navigation 1s used in the development of the SANS. The feasibility of this combination 
was evaluated favorably in [MCKE92]. The hardware and software architecture required 


to perform the mapping phase of the mission were defined and evaluated in [STEV93]. 
B. THE RESEARCH OUESTIONS 


The research guestions of this thesis are: 


e How will the ocean surface and salt-water affect the ability of a GPS antenna and 


receiver to continue tracking satellites used by the SANS to determine location? 


e What current technology and equipment are proposed for use in the production 


of a prototype SANS? 


+ Will the current SANS design and hardware meet all of the performance 


objectives for this mission? 
C. SCOPE, LIMITATIONS AND ASSUMPTIONS 


This thesis reports the findings of the third year of research in an ongoing research 
project. The scope of this investigation 1s to determine how the ocean water will effect the 
ability of the SANS to use GPS navigation with an antenna on the surface of the water, and 
to develop a computer simulation written in LISP, that will determine the error introduced 
by using an accelerometer in the SANS as part of the Inertial Navigation System (INS). The 
objectives for this project are described by McGhee et al. [MCGH92] as: 


* Low Power Consumption. Operation from an external battery pack for 24 hours 


is desirable. 


e Limited exposure time. GPS antenna exposure time in the mapping phase should 
be minimized. Up to 30 seconds exposure allowed, but intervals between such exposures 


should be as long as possible, exceeding several minutes at a minimum. 

e Maintain covert operation. The GPS antenna should present a very small cross 
section when exposed and should not extend more than a few inches above the surface. 

e Maximize accuracy. For the mapping phase of the mission, system positioning 


accuracy of 10 meters rms or better is reguired with post-processing, both submerged and 


surfaced. 


e Minimize size. Total volume is not to exceed 120 cubic inches. An elongated, 


streamlined package is preferred. 
D. ORGANIZATION OF THESIS 


This thesis provides an evaluation of the hardware and software used in a low cost 
version of SANS called the interim SANS.[STEV93] No changes have been made to the 
software system in this research, however the software system is described. Changes have 


been made to the hardware system which have been evaluated, as well as additional testing 


of the system that demonstrate its ability to operate in the ocean, based on the mission 
requirements. This thesis is organized into seven chapters. 

Chapter II reviews the previous work on this project as well as previous and current 
work on GPS navigation, AUV submerged navigation, and robot kinematics and dynamics 
simulation. 

Chapter III is a detailed problem statement. This includes the mission requirements, 
and the problems related to GPS navigation, submerged navigation, and the LISP 
navigation simulation. 

In Chapter IV is a detailed description of the hardware and software currently in use 
for this project. It explains the hardware components currently used in the SANS and 
includes a description of their capabilities. Photographs of each piece of hardware are 
included. Chapter IV also describes the software designed and detailed in Stevens 
[STEV93]. 

Chapter V is a description and presentation of the results of the demonstration 
system testing performed, and an assessment of the system's ability to achieve the mission 
requirements. 

Chapter VI is a description of the LISP simulation code used to determine expected 
error rates of the measurement of horizontal distance travelled. This includes an 
explanation of the class and object hierarchy used, and a sample display from a simulated 
AUV surfacing. 

Chapter VII presents the conclusions of the software and hardware testing and 


provides recommendations for future research. 





IL SURVEY OF PREVIOUS WORK 


A. INTRODUCTION 


Autonomous Underwater Vehicles (AUVs) have a potential for use in many 
different applications. One very important aspect of AUV control is navigation. Many 
potential applications require highly accurate navigation. This chapter will discuss some of 
the various possible solutions for navigating an AUV, and how robot kinematics and 
dynamics can be used for computer simulation of the actions of the AUV and therefore the 
requirements for navigation systems. The types of navigation can be split into two 
categories, external signal based navigation and sensor based navigation. 

External signal based navigation provides positioning information only when the 
signal receiver is exposed to the signals, above the ocean surface, such as Loran, Omega 
and the Global Positioning System (GPS). Loran and Omega both are relativel y inaccurate, 
and Loran provides limited coverage. Because GPS provides continuous worldwide 
coverage and 1s highly accurate, 1t will be the focus of this survey. 

Sensor based navigation constitutes a self-contained system which can be made up 
of a wide variety of equipment that can be used to determine the submerged location of an 
object. These can be grouped into four types: dead reckoning, inertial navigation systems 
(INS), acoustic navigation, and geophysical mapping comparison. Sensors are subject to 
drift. On long AUV missions they are not able to provide the accuracy required for many 
applications. High quality INS are expensive as are acoustic beacons. Acoustic beacons 
must be predeployed at precisely known locations, and geophysical map interrogation 
requires a good bottom elevation map previously stored on the AUV”s computer. 


[TUOH93] 
B. GPS NAVIGATION 


The Navigation Satellite Timing and Ranging Global Positioning System or 
NAVSTAR GPS is a United States Department of Defense project that was started in the 


1970's to attempt to provide the military with precise navigation capability and accurate 


timing. [PARK80] and [BOSS85] It is a space-based radio positioning, navigation, and 
time-transfer system. The fully operational GPS system now provides 24-hour, all weather 


navigation capability, by providing total earth coverage using 24 satellites orbiting the earth 


in circular 20,200 km orbits at a 55° inclination with 12-hour periods. They operate on two 
L-band frequencies, L1 (1575.4 MHz) and L2 (1227.6 MHz). Superimposed on these two 
carrier frequencies is navigation and system data, predicted satellite ephemeris, or position 
information, atmospheric propagation correction data, satellite clock error information, and 


satellite health data. [VAND80] and [WOOD85] 


There are two unique and distinct navigation services available from the GPS 
satellites, the Standard Positioning Service (SPS) and the Precise Positioning Service 
(PPS). In order to degrade the accuracy of SPS, an intentional inaccuracy is introduced into 
the satellite broadcast signal through a process called Selective Availability or SA. 
[KREM90] This limits SPS to worldwide coverage with 100 m horizontal accuracy with a 
95% confidence level. PPS access is controlled by the use of cryptographic devices which 
remains restricted to US and allied military and highly selective, specific US non-military 
uses that are in the national interest. PPS provides the highest stand alone accuracy, 15 m 
SEP (Spherical Error Probable), a velocity accuracy of 0.1 m/sec, and a timing accuracy of 


better than 100 nanoseconds.[VAND80] and [WOOD85] 


To take full advantage of the high accuracy potential of GPS, without the 
cryptographic equipment required for access to the P-code, the civilian community has had 
to determine a way of filtering the errors and improving the accuracy of the SPS. The 
solution was differential GPS or DGPS. DGPS uses one or more stationary antennas and 
one moving antenna to yield position with a much higher accuracy. This simply entails 
placing a receiver at a known location, determining the position, or pseudo range, errors 
and broadcasting the corrections to nearby users. [KREM90] Real-time differential 
processing and differential post-processing can improve GPS accuracy to 2-4 m with SA 


on or off, without the need for PPS [CLYN92] and [COCO90]. 


Over the last several years, GPS has been adapted for use in virtually every type of 


transportation in the military and the civilian world. The cost and the size of GPS antennas 


and receivers have decreased significantly, making practical new uses that had only been 
concepts in the past. GPS is now used heavily on aircraft and nearly every size and type of 
ship. Itis now even being used in automobiles and hand-held units are used by backpackers. 
[KRAU93] 

Given the level of accuracy provided by GPS and the great decreases in size and 
cost of receivers, GPS is an obvious choice for use in AUV navigation. Many researchers 
have begun to include the capabilities of GPS into their applications. In [YOUN91], 
Youngberg suggests that free-roving buoys be used to translate GPS radio-based signals to 
an underwater acoustic-based signal. These sonobuoys (123 mm diameter x 910 mm long, 
5-15 kg) would contain a GPS antenna, GPS receiver, processing and control subsystem, 
acoustic transmitter, battery power, and homing beacon. The AUV could then determine its 
position based on the ranging and position fixing of the buoys. A simulation of this type of 
system was done with a 1 km distance between buoys and a couple of hundred meters 
distance to the AUV. It is proposed that an accelerometer, a Kalman filter, and DGPS be 
used to overcome the errors caused by the ocean waves and variations in altitude. Each GPS 
buoy would broadcast its position data via spread spectrum signals used by the AUV for 
ranging. This would save much of the time and effort that must be spent to position and 
calibrate transducers. [LEU93] 

Another buoy system, the NAVSYS TIDGET, was developed as a low-cost, 
disposable GPS for military sonobuoys that are air-launched and float on the surface. The 
design requirements were: 

* Cost « $150 

¢ 10 m accuracy 

e Sized to fit within existing sonobuoys 

e Antenna to fit in the sonobuoy float bag 

e Time To First Fix nearly instantaneous 

e No modification to the airborne acoustics processor 

e Operates in all sea states 


e Maximum update rate of 10 seconds 


e No pre-launch initialization requirement 
e Povver € 1 W continuous 
The TIDGET was able to meet all of the design reguirements. [BROW93] 


Another area of continuous improvement is miniaturization. GPS receivers have 
been able to maintain or even improve in performance while getting much smaller. For 
example, the Furuno GPS Receiver Module LGN-72 is an eight-channel receiver which is 
a single printed circuit board that reguires only 2 W of power and is 100 mm x 70 mm x 20 


mm. [SOUE92] 


(El AUV SUBMERGED NAVIGATION 


Dead reckoning in some form has been used for navigating longer than any of the 
other methods. Position is calculated by integrating the velocity of the vehicle in time. 
Velocity can be determined simply by using a compass for heading measurement and 
tracking speed. Modern dead reckoning systems typically use magnetic or gyroscopic 
heading sensors and a bottom or water locked velocity sensor. [GROS92] Errors are 


introduced by the unknown movement of the vehicle caused by ocean currents and waves. 


There are many ways to calculate position while submerged. Velocity 
measurements are available from Doppler sonar, or from correlation velocity log (another 
type of sonar). Position can be measured directly by laser scanning, CCD cameras, side 
scan sonar, and magnetic field measurements. Position can also be inferred by double 
integration of acceleration as in Inertial Navigation Systems (INS). CCD cameras operating 
close to the bottom may be used to recognize features and compare them to a reference 
map. Side scan sonar measures variations in the ocean bottom backscatter. [BERG93] INS 
determine position by a combination of precision orientation or angular rate sensors and 
accelerometers. There are many different varieties of angular sensors and accelerometers. 
These include using fiber optic gyros, ring laser gyros, vibratory rate sensors, high 
performance Inertial Measurement Units (IMUs) with three inertial grade angular rate 


sensors and three precision linear accelerometers, and three-axis magnetometers with two- 


axis inclinometers. All of these sensors are subject to drift errors hovvever, and the error 
increases with time. Also, high guality sensors are very expensive. 

Acoustic navigation uses the time of arrival and direction of the acoustic signal 
relative to an array of transponders to determine position. There are long, short, and 
ultrashort baseline systems (LBL, SBL and USBL). [TUOH93] For LBL, the acoustic 
beacons must be predeployed at a position that is known to an accuracy greater than that 
desired for the AUV. Long baseline navigation has been tested [BELL92] in which the 
AUV passively listens to the synchronized emissions of the array, where the transponder 
locations are known. The transponders are separated by 100 m to 10 km, depending on the 
freguency of operation used by the system. The vehicle uses the differential time of arrival 
of the acoustic pulses to determine its position. The advantages of the LBL system are that 
it can be used by multiple vehicles at one time, the hardware is fairly simple and small, and 


1t requires minimal power usage by the AUV. 
This system is being researched for use in Arctic under-ice surveying with transits 


of up to 10 km and mapping operations over an area of 1 km?. [BELL93-2] Another 
application which uses three forms of navigation is the Odyssey AUV [BELL93-1] using 
dead reckoning, LBL to determine the position relative to the transponder array, and ultra 
short baseline which is used to track the AUV from the surface. A similar proposal is 
analyzed in [ROER93] where it is proposed to use an AUV to collect data under oil spills, 
at a depth of 1-3 m. A boom floating on the surface is used to surround the oil spill and the 
AUV would have to maintain a position relative to this boom. The proposal is to place three 
acoustic transponders on the boom, and the AUV would navigate relative to the 
transponders. Error would be introduced due to the movement of the boom and acoustic 


multipath and water column thermoclines. 


Geophysical mapping comparisons may be achieved using various technigues. 
They take measurements of simple geophysical properties with vehicle mounted sensors 
and match those properties to computer models on board the vehicle. [TUOH93] These 
geophysical properties may be magnetic field intensity, bottom topography or a known 


image of a structure. The sensors used are either sonar or acoustic transponders. Some 


examples of sonar mapping include the use of multibeam sonar for a sea floor profile, 
vvhich measures the depths at different angles to get an accurate profile of the sea floor 
[BERG93], use of high frequency sonars which yield resolution which can detect objects 
in the 50 to 100 m range [CRIS93], and EDOs new doppler precision velocity sensor which 
uses the latest digital signal-processing technigues and includes a completely new planar 


transducer array. [JORG94] 


The Brimingham Acoustic Signalling System (BASS) testing was described in 
[COAT93]. This used a differential phase shift keyed, line-of-sight, data link which 
successfully transmitted over distances to 250 m. They used a 1/50 scale model of an 
underwater oil rig, and placed the model transducer within the model rig. The resulting data 
was then used torun a database search of the possible positions in and around the structure. 
They found that it is possible to determine the position of the model transducer to an 
accuracy egual to the guantization cell size of the map stored in the database. This does not 
provide direction of motion however. A two-tier position estimation procedure 1s proposed 
which would use both macro- and micro-navigation. [TUOH93] The macro-navigation is 
a coarse-scale position estimation via a logic-based interval filter and multiple hypothesis 
tracking. The micro-navigation 1s a fine-scale, quantitative position determination through 
interrogation of low-level physical property models which represent a continuum of 
possible locations. This approach is similar to the terrain contour matching guidance 
system of cruise missiles. [CZES93] and [HINR76] The drawback to any type of 
geophysical mapping comparison is that a good map must already be available and be 


stored in the computer database. 


A combination of various systems has the potential to greatly reduce the 
disadvantages of any one system alone. Velocity aided navigational systems offer greater 
precision and less cost, and reduce the complexity and stability requirements of an INS. A 
precision velocity sensor can be used to provide drift compensation to an INS. The 
correlation sonar illuminates the ocean bottom to get a characteristic sonar signature. Then, 
the correlation velocity log (CVL) [GROS92] provides a method for determining absolute 


velocity relative to the ocean floor at a stand off distance much greater than other velocity 
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measuring techniques. A miniature AUV has been successfully used under Artic ice, vvith 
a dead reckoning system, comprised of a fluxgate compass, pressure transducer, pitch/roll 
sensor, yaw-rate gyro, and an acoustic homing system. [LIGH93] and [OSSE93] Theseus 
uses a combination of dead-reckoning using a medium accuracy INS, a doppler sonar, and 


an acoustic positioning system. [BUTL93] 


McKeon proposed a combination of GPS and INS to allow an AUV to determine 
position information while submerged, and to surface in order to re-initialize the sensors 
with the high accuracy of the GPS. [MCKE92] This concept has received much attention. 
Early computer simulations using GPS to correct INS errors showed GPS estimated errors 
of 43 m. [NAGE92] An extended Kalman filter has been adapted for an AUV to optimize 
INS navigation. [MILL91] Several combination GPS/INS systems have been proposed and 
developed. Litton is now producing two completely solid-state INUs which use navigation 
quality fiber optic gyros (FOG) and micromachined silicon accelerometer (SiAc) 
technology [COX94]. Another is the Honeywell H-764G Integrated Embedded GPS/INS, 
which uses a ring laser gyro (RLG) based strapdown INS. This system has demonstrated 
pure inertial performance of less than 0.8 nmi/hr and GPS aided performance of less than 
16 meters SEP. The combined system provides outstanding performance with fewer than 
four satellites in view, is reduced in size, weight and power requirement, and is simple to 


install. [MOY A93] 


Two submersibles that are designed to surface to transmit data and establish a GPS 
position to update onboard guidance systems are DOLPHIN and DOGGIE. [HADD93] 
DOLPHIN (Deep Ocean Long Path Hydrographic Instrument) will navigate across the 
oceans conducting a continuous series of hydrographic measurements. It is intended to 
undulate between the surface and the ocean floor, surfacing at intervals of about 30 km to 
receive GPS position updates. The DOGGIE (Deep Ocean Geological and Geophysical 
Instrumented Explorer) is designed to investigate at a much finer resolution, features that 
have been identified initially with a sonar survey. It would have a 3-5 day mission of about 
500 m above the sea floor and an area of 50 km x 50 km. The DOGGIE would also surface 


periodically and update the drift error in its dead reckoning sensors. The designers of these 
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two systems found that "...it is possible to reconstruct the GPS data message despite 
periodic signal outages...". An analysis of various types of INS systems can be found in 
[MCGH92] Various combinations of GPS/INS systems are available that can either be 
designed by the user or bought off-the-shelf. These combinations are able to provide very 
accurate, high rate, position and velocity information which doesn't degrade over time 


[BROW92-1]. 
D. ROBOT KINEMATICS AND DYNAMICS SIMULATION 


Robot kinematics is a systematic approach of using vector/matrix algebra to 
represent the spatial geometry of an object with respect to a fixed frame of reference and 
as a function of time. Robot dynamics uses the mathematical equations and physical laws 
describing motion such as Newton-Euler equations to represent motion from applied forces 
and moments. [FUS7] Computer simulation of robot motion is a very useful tool. 
Simulation can be used to determine desired motions, to analyze motions, and to determine 
the results of motions. The motion of rigid bodies, as described in physics and engineering, 
can be used to simulate movement to a desired location. [DA V193] Forward kinematics and 
dynamics compute the Cartesian space position and orientation of a rigid body from the 
parameters that describe the body. [FU87] Davidson provides a thorough explanation of the 
kinematics and graphical computer simulation code for the Aquarobot, an underwater 
walking machine, written in Common Lisp Object System (CLOS) and C++. The object- 
oriented programming approach used in this work allows for the design of a complex 
system made of many components that may be governed by different physical laws. 
[DAVI93] This allows the programmer to easily make adjustments and modifications to 
individual components of the system in order to determine the effects of changes to the 


system being modeled. 
E. SUMMARY 


As shown in this survey, there are a multitude of possibilities that can be used for 


navigating an AUV. The choices range from simple dead reckoning to complex systems 
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that combine GPS and INS or GPS and acoustic navigation. The type of navigation system 
desired for a particular mission must be determined after analyzing the expected use of the 
AUV. A navigation system designed for one AUV may be extremely successful, but it may 
not adapt well to an AUV of a different size or with a different mission and with different 
requirements for accuracy. Because the range of possible systems is so broad, a computer 
simulation of an AUV with known mission parameters is a useful technique for 


determining an optimum navigation system design. 





IH. DETAILED PROBLEM STATEMENT 


A. INTRODUCTION 


As stated in Chapter II, there are many possible systems that could be used for AUV 
navigation. The role and mission of the AUV vvill greatly influence any navigation system 
design. The research of this thesis was done in support of an AUV with a primary mission 
of covertly mapping the location of objects of interest underwater. The AUV will be 
launched either from shore or from a boat, and will search a particular area for specific 
objects. Because the mission 1s covert, the search area may be a considerable distance from 
the launch area. Therefore the mission is broken up into two phases. The first phase 1s the 
transit phase, which will begin at the launch site and continue to the mapping location, and 
possibly between multiple mapping locations, then back to a recovery location. The AUV 
may be surfaced or intermittently submerged during the transit phase. The second phase is 
the mapping phase. The mapping phase of the mission will consist of repeated dives by the 
AUV to locate the object or objects of interest. An experimental AUV designed for this 
type of mission 1s described in [HEAL92]. 

The Small Autonomous Underwater Vehicle Navigation System (SANS) was 
proposed as a way to determine the precise location of any objects found by the AUV 
[MCGH92]. A GPS/INS combination was proposed for the SANS [MCKE?92] in order to 
attempt to meet the research objectives described in [MCGH92]. The SANS was designed 
as an externally mounted, self-contained navigation system which could be used on a 
variety of AUVs for mapping the locations of objects found underwater. The specification 
for SANS requires that total volume not exceed 120 cubic inches and the package be in an 
elongated shape. The system must provide positioning accuracy of 10 meters rms or better 
with post-processing, while submerged and surfaced. In order to avoid detection, the GPS 
antenna must not extend more than a few inches out of the water, and must have a small 
cross section. Also, the antenna exposure time during each surfacing should be minimized 
to 30 seconds or less, with intervals between exposures of at least several minutes. Finally, 


the system must be able to operate from an external battery pack for up to 24 hours. 
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An interim SANS vvas designed and tested on land by Stevens [STEV93]. This is 
an interim design because it lacks the ability to locate multiple objects before surfacing to 
update the SANS sensors. The proposed solution with the current hardware is to reguire the 
AUV to surface after each object is located, obtain a GPS fix for updates, then continue the 
mapping phase. This is referred to as a “pop-up” maneuver. With improved system 
components, the need for this pop-up maneuver should be eliminated during the mapping 
phase. A proposed final SANS design called the baseline system [MCGH92], would 
contain those improved components. 

Stevens found that by using differential post-processing, a GPS/INS combination 
using miniature gyroscopes and other commercially available equipment can provide the 
accuracy as well as the minimum exposure time required by the mission within the cost 
constraints of the project. However, this system was subject to a limitation on maximum 
climb or dive angle to prevent gyro tumbling. [STEV93] As a continuing evaluation of that 
interim system, this thesis is focused on experimental testing to determine its ability to 
operate and meet system objectives on and under water, and a computer simulation to 
determine the accuracy of a system that replaces the gyroscopes with accelerometers, to 


both reduce cost and eliminate restrictions on climb or dive angle. 
B. GPS NAVIGATION 


GPS navigation is able to provide highly accurate, worldwide positioning data very 
quickly. As described in the preceding chapter, the two positioning services available are 
the Standard Positioning Service (SPS) which is available to everyone, and the Precise 
Positioning Service (PPS) which is encrypted for restriction to US and allied military. 
Using SPS, the accuracy of the positioning information is limited to approximately 100 
meters horizontal accuracy [VANDS80]. PPS could be used for navigation systems on 


military applications such as this project. However, as shown in Table 1, using differential 
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GPS eliminates any need or desire to incur the potential risk involved in having 


cryptographic keys in the navigation system of an AUV. 
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Table 1. GPS Positioning Accuracy (in meters) after [STEV93] 






GPS navigation and a magnetic compass will provide the primary source of 
navigation data while in the transit phase of the AUV mission. The AUV must be able to 
submerge for short intervals and still maintain accurate navigation after resurfacing. The 
underwater mapping phase of the mission will require both surfaced and submerged 
navigation. The INS sensors used in the SANS are constrained by size and weight. The 
interim SANS has an additional cost constraint. Therefore the quality of the sensors used 
will require frequent updates in order to maintain adequate accuracy. The AUV will be 
required to surface in the area of the object found (perform a pop-up maneuver) to obtain a 
GPS fix, which will be used to record the current position and, with post-processing, 
extrapolate this position backwards to the submerged object. 

The GPS receiver chosen for use in this research is a Motorola PVT-6 which can 
simultaneously track up to six GPS satellites. It is capable of providing position accuracy 
of better than 25 meters, SEP without Selective Availability (SA) on, 100 meters with SA 
on, 0.1 meter/second velocity accuracy, and a Time-To-First-Fix (TTFF) of about a minute, 
with reacguisition time in less than 4 seconds when the antenna has been obscured for 60 
seconds. [MOTO93-2] There are different power-up states for GPS receivers, and the 
TTFF varies depending on the power-up state. This is discussed further in the description 
of the Motorola PVT-6 in Chapter IV, and the complete specifications are listed in 
Appendix A. This receiver is capable of providing positioning data within the accuracy and 
time reguirements of this project, under normal operating conditions [STEV93]. A new 
series of tests was performed to determine the GPS capabilities of the receiver when 


interacting with sea water. The results obtained are also presented in Chapter IV. 
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In order to avoid detection, the antenna for the navigation system must be as 
unobtrusive as possible, from the air, vvater and land. This means that it cannot be very 
large, or protrude out of the water more than a few inches. Typical ocean uses of GPS, such 
as the buoys described in [BROW93] and [LEU93] are designed to place the antenna well 
out of the water. With an antenna that is located on or just above the surface of the ocean, 
wave-wash will obscure the antenna. The freguency and the length of time that the wave 
wash would cover the antenna, as well as the depth of the water, will effect the ability of 
the receiver to obtain a GPS position fix. Chapter IV explains the tests that were run to 
determine the extent of the degradation in the ability to use GPS navigation under these 


circumstances. 
C. SUBMERGED NAVIGATION 


As previously stated, the mission of the AUV under study [HEAL94] and the SANS 
IS to provide precise position information relating to a submerged object. In the interim 
system, when an object is found during the mapping phase, the AUV must surface. In order 
to determine the distance and direction from the submerged object to the surface, where a 
GPS position fix can be obtained, the depth change, heading or direction of travel, and the 
climb angle must be known. With this information the submerged location can be 
extrapolated from the surfaced location. Figure 1 shows an arbitrary path of a surfacing 
AUV. The average climb angle is represented by 0, Z is the depth change and A is the 


horizontal distance traveled. The horizontal distance is calculated using Equation 1. In 





Figure 1. Computation of Horizontal Distance Travelled from [KWAK93] 


order to improve the accuracy of the computation, these measurements are recorded at 
small intervals vvhich SANS sums to obtain the final resulting distance. 
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These measurements are obtained from various sensors contained in the SANS. The 
depth change 1s measured by a depth transducer and the heading is measured by a flux-gate 
compass. Two approaches to measuring the climb angle of the AUV were described in 
[STEV93]. The first approach used a miniature gyroscope. The orientation of the AUV 
when a submerged object is located was assumed to be near level. Since the gyro measures 
only relative position, the climb angle would be determined relative to that near level 
position. The climb angle is computed based on the change in orientation of the AUV. The 
second approach is to determine the climb angle using an accelerometer (inclinometer). 
This approach and the inherent errors in its use are described in [MCGH93]. Specifically, 
an accelerometer measures the total acceleration of an object. The output of a 
longitudinally oriented accelerometer is shown in Equation 2, where a is the longitudinal 


acceleration of the AUV, g is gravitational acceleration, and @ is the climb angle. 
sensed —acceleration = a+ gsin (8) Eq 2 


When the AUV begins to surface, it will have to accelerate. However, if the AUV has 
constant velocity, then the longitudinal acceleration is zero, a = 0, and the equation is 


simply 

gravity — component = gsin (0) Eq 3 
SO 

sin (0) 2 gravity — component/g Eq 4 


The eguation normally used for determining the pitch attitude of a static object with an 
inclinometer is Eguation 4. But because the accelerometer is on a moving platform, this 


must be modified to Eguation 5. 


sin (apparent —0) 2 sensed — acceleration/g Eq 5 
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From Equation 2 and Equation 5, vve get Equation 6, vvhere a/g represents the error betvveen 
the sin of the actual climb angle and the sin of the apparent climb angle sensed by the 
accelerometer. That 1s, 

sin (apparent -0) = sin (0) + a/g Eg 6 
So, 

a/g — sin(apparent — 0) — sin (0) Eq 7 
From Equation 1 and Equation 7, the horizontal error introduced by the error in the climb 
angle is calculated as: 

horizontal — errorz ad — olio) Eg 8 
tan(0) tan (apparent — 0) 

Therefore, the apparent climb angle of the AUV can be calculated based on 
information from the accelerometer, and with the depth change from the depth transducer, 
the horizontal distance can be computed, again using Equation 1. Further explanation of the 
calculations required are presented in Chapter V, Section E. The error in this calculation 
comes from the effects of longitudinal acceleration. Also, in this system configuration, the 
accelerometer would be mounted along the body axis of the AUV. If the velocity vector of 
the AUV deviates from the longitudinal body axis, this would add an additional error. By 
performing bounding calculations, McGhee concluded in [MCGH93], that the error 
generated by an accelerometer used for determining climb angle is acceptable, in part 
because of the motion limits of the AUV. Additionally, as the AUV reaches the surface, it 
will decelerate. This deceleration will tend to cancel out the errors created from the 
acceleration. These effects will be treated quantitatively for typical surfacing maneuvers 


in Chapter V. 
D. NAVIGATION SIMULATION 


A computer simulation of an AUV with the SANS has been created in order to 
simplify the process of determining the errors created by the sensors. This simulation is 
written in CLOS (Common LISP Object System), an object-oriented programming 


language. This allows the AUV and the SANS to be represented as objects and classes that 
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are put together to create an entire system. The simulation is designed as an AUV which 
has the physical properties of a rigid body and a separate SANS which 1s also a rigid body. 
The SANS has a link to the AUV to allow them to move as one unit. This unit can move as 
reguired to simulate the actual mission. Using forward kinematics and dynamics based on 
Newton-Euler eguations [FU87], the final Cartesian coordinates of the system can be 


determined. 


CLOS also permits each class to have local and shared slots with accessible slot 
values [KOSC90]. Within the SANS simulation, each sensor has a slot containing the 
measurements that would be obtained by that sensor in the actual navigation system. This 
simulation allows for making various changes to the parameters of the AUV mission, or 
sampling a number of missions. By running a new simulation, an estimate of the resulting 
error can guickly and easily be determined. For example, the simulation can be run using 
any climb angle or any depth desired to determine how these changes effect the total error. 
The eguations for determining the errors in the simulation are the same ones explained 
above and in Chapter V, Section E. A graphical representation of the AUV and SANS was 
included in the simulation as a way of visually demonstrating the approximate error of the 
system. This simulation could be tailored to different types of AUVs, using different types 


of sensors as well. The simulation program is explained in detail in Chapter VI. 
E. SUMMARY 


Navigation system design for an AUV is greatly influenced by its mission. 
Therefore the mission reguirements have been explained. GPS navigation has some unigue 
problems to overcome in order to allow the AUV to remain undetected when surfaced. This 
research continues the evaluation of the interim system described in [STEV93], 
determining how the SANS will perform when used in the ocean. This study includes 
analysis of data collected from experimental testing 1n the lab to determine the performance 
of the GPS antenna and receiver with limited exposure time. It also includes experimental 
testing in the lab and on the ocean to determine the effect on GPS navigation of the wave 


wash over the antenna. 


eu 


The use of an accelerometer, instead of a gyroscope, to determine the climb angle 
of the AUV is explored in this research. The accelerometer provides the sensed acceleration 
of the AUV, which is composed of the AUVs longitudinal acceleration plus the 
gravitational acceleration multiplied by the sin of the climb angle as seen in Eguation 2. 
Therefore, with the additional information provided by the depth transducer and the flux- 
gate compass, the climb angle and heading can be calculated. A graphical computer 
simulation has been developed to simplify the process of determining the climb angle based 
on the eguations described, and the error of this system under various mission parameters 
using various system configurations has been examined. Simulation results can be used to 
determine the accuracy requirements of the components in order to meet the overall system 
accuracy goal. Any motion restrictions or requirements that may be imposed on the AUV 


can also be included in the simulation. 
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IV. SYSTEM DESIGN 


A. INTRODUCTION 


The Small Autonomous Undervvater Vehicle Navigation System (SANS) design 
studied in this research is essentially the same as the interim system described in [STEV93] 
and [KWAK93] with the exception of a new version of the core module, a new, smaller A 
to D converter, and an accelerometer rather than gyroscopes to determine the climb angle 
of the AUV while surfacing. Only computer simulation results of the change to an 
accelerometer are given. No experimental testing of the complete system has been 
performed with the new eguipment, although considerable evaluation of components has 
been conducted as part of the work of this thesis. 

The hardware for this interim system was chosen to meet the reguirements of size, 
welght, power and cost. There are many alternative choices for commercially available 
hardware, and there are inertial navigation systems which would meet or exceed the 
requirements for this project. For example, Systron Donner Corporation has a small high 
performance inertial measurement unit TMU) [GYRO92] that is expected to meet the 
requirements of this mission. Additionally, its accuracy is sufficient to lenghten the time 
required between updates of the sensors to allow the AUV to locate multiple targets before 
surfacing to obtain a GPS fix. The baseline system as described in [MCGH92] would 
include the hardware needed to accomplish this. However, the cost of those sensors 
prohibited them from being included in this testing. This chapter describes the hardware 
used in this modified interim system. Technical specifications of each device are included 
in Appendix A. 

The software design of the SANS has not been modified in any way since it was 
described in [STEV93]. It is an object-oriented design in Ada, using assembly language for 
low level, high frequency operations. The software is made up of three primary operations 
related to the mission. These operations are monitoring the AUV, navigation data-logging, 
and GPS data-logging. Each of these operations consists of software objects, and 


operations performed within that object that are related to individual sensor data. In order 
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to ensure that the software could be adapted as the SANS evolves, the softvvare vvas 
designed with code reuse as an important feature. A high level description of the software 


is included in this chapter. 
B. HARDWARE DESCRIPTION 


The hardware design chosen to accomplish the mission requirements described in 
Chapter III are shown in Figure 2. The total volume of the equipment must not exceed 120 
cubic inches, therefore size was a primary concern in choosing hardware. Recent advances 
in miniaturization have made the task of finding adequate equipment in small sizes much 


easier, but miniaturization adds to the cost of the equipment. 


A/D Depth Cell 
Flux Gate Compass 


Mission GPS 
Platform Interface ene 
Antenna 
Data 
Storage 


Figure 2. Hardware Block Diagram for Interim SANS after [KWA K93] 





1. Mission Computer 


Dovatron E.S.P. 8680 (Extra Small Package) core module, shown in Figure 3, was 


designed specifically for the developer who has space and power limitations which reguire 
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off-the-shelf PC-compatible solutions. The E.S.P. provides small size, modularity, PC- 
compatibility, low power consumption, and availability of many off-the-shelf modules. 
The core module contains a graphics controller, serial interface, memory, keyboard 
controller and ROM-based software. It can be used with any IBM-XT compatible keyboard 
and monochrome or color CGA monitor. The core module contains a 14 MHz Chips and 
Technologies F3680 PC/CHIP, 512 kilobytes or 1 megabyte of dynamic RAM, ROM- 
based software, a PCMCIA connector which can have up to 32 MB of memory, and the 
necessary support chips. The core module memory can be expanded using additional 
modules that plug into the backplane. [ESP93-1] The core module is 1.7 x 5.2 x 4.7 inches 


(41.54 cubic inches), and all modules are designed to conform to that standard E.S.P. 


dimension. 
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Figure 3. E.S.P 8680 Core Module 


In order to conserve power, there are four different power modes. “Run” mode is 
the normal operating mode which consumes the most power but offers full PC/CHIP 
performance. The “drowsy” mode uses PC/CHIP hardware to insert delay cycles between 


instructions. This is typically used when performance is not important, but low-level 
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processing 1s required. “Sleep” mode stops all of the clocks to the PC/CHIP, and they are 
not restarted until an interrupt or DMA request occurs. In the “suspend” mode, the real-time 
clock inside the chip is powered, and the external memory may be powered. This allows 
the application to be suspended, and it can be resumed at any time. An input to the PC/CHIP 
is used to control the entry into and exit from suspend mode. The software will bring the 
system to an orderly shutdown and when returning to normal operations will restore the 
clocks and power to the module, with all internal registers and memory preserved. System 


power can be reduced to microwatts while in suspend mode. [ESP93-1] 


The E.S.P. 8680 comes with a Flash EPROM (Erasable Programmable Read Only 
Memory), which is an electrically-erasable ROM that can be reprogrammed. Using Flash 
memory technology, this add-on card emulates an ordinary magnetic Hard Disk. The disk 
portion of the ROM can be read, written and edited without removing the ROM or using 
additional devices. It is mounted in a standard 32-pin PLCC socket. The E.S.P. Flash Disk 
Is a memory card which is non-volatile, programmable and low power, that appears just 
like a hard disk drive to the operating system and can be used with any program that runs 
under DOS. No device drivers or other software are reguired. [ESP93-3] The Flash 
EPROM is available in capacities from 1 to 16 MB, and is 1.7 x 5.2 inches, the standard 


E.S.P. form factor. 


The E.S.P. 8680 has a PC Memory Card International Association (PCMCIA) 
connector and electrical interface for memory cards. The interface supports ROM, RAM 


and flash memory cards, and can provide up to 32 MB of memory. [ESP93-1] 


2. AtoD Converter 


The Dovatron E.S.P. Analog to Digital Module, as seen in Figure 4, is based on an 
existing ISA plug-in card. It provides an interface for data acguisition, control, monitoring, 
and parameter measurement. This module provides for measurement of up to 16 single- 
ended channels (in seguence mode, the seguencer address starts at 0, and progresses until 


the address count is egual to the count selected in the program, so only 15 channels are 
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usable), or 8 channels in differential mode, and includes many of the features normally 
found on full sized PC peripheral A to D cards. The module uses an Intel 82C54 
programmable interval timer which provides three independent 16-bit counters, each with 
six programmable counter modes and either binary or BCD counting. Again this E.S.P. 


converter 1s in the standard size of 1.7 x 5.2 x 0.7 inches. [ESP93-2] 





Figure 4. E.S.P. A to D Converter 


3. GPS Receiver 


The Motorola PVT6 receiver, shown in Figure 5, is capable of tracking six satellites 
simultaneously and of performing real-time differential processing. It can provide better 
than 25 meter position accuracy and 0.1 meter/second velocity accuracy without selective 
availability (S/A) on, without differential processing. Differential processing improves the 
accuracy to one to five meters. It can be powered with unregulated 12 Vdc or regulated 5 
Vdc. Keep-alive random access memory (RAM) allows the receiver to retain satellite 


ephemeris data and real-time-clock (RTC) information which require an external 12 V or 
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Figure 5. Motorola PVT-6 GPS Receiver 


5 V battery. The receiver is 3.94 x 2.76 x 0.65 inches (7.06 cubic inches), weighs 4.5 oz., 
and uses 1.3 W of 5 Vdc input or 1.8 W of 12 Vdc. 


There are four different power-up states, cold-2, cold-1, warm and hot as shown in 


Table 2, from Motorola's GPS Receiver Technical Manual. Cold-2 is the state the receiver 


a a a uu a a at ate mati 


^ 
. o ' 


Hor [100km]75 mises] 3min | Tmonth | «ch 30 se | 


Dosi lle N/A N/A U/A I month U/A | 7.9 min |15.0 mi 


Table2. TTFF Information from [MOTO93-1] 





is in the first time 1t is turned on, or any time the receiver is without power for more than a 
month. The receiver will not have the current date and time and will have to search for all 
available satellites. After it finds the first satellite, the date and time are corrected and it will 


continue to acquire other satellites. Cold-1 state occurs when the receiver has lost power, 


——— 


so the RTC and the RAM are erased, but the almanac is less than a month old. A cold start 
is guite slow, but if the receiver maintains its battery power, a cold start is reguired only the 
first time it is used. Once the receiver is tracking three or more satellites, position 
computation is done automatically. The receiver stores the almanac and the ephemeris data 
as well as the position of the receiver and the time in RAM, making it much faster to acguire 
satellites from a warm or hot start. A warm start is when the position and time are known, 
but the ephemeris data is too old to be useful, about four hours. A warm start has a Time- 
To-First-Fix (TTFF) of about one minute. Finally, a hot start provides the fastest TTFF, 
usually under 30 seconds. It is able to use the ephemeris data stored in RAM, along with 
the position, time and almanac to find satellites. The mission of the AUV will allow the 
SANS to always remain in a hot state after launch. Reacguisition time is the time it takes 
for the receiver to reacguire the satellite signals that are lost when the signals are obscured. 
As seen in Table 3, from Motorola’s GPS Receiver Technical Manual, this time is a 


function of the time that the signal is obscured. Chapter V provides TTFF and reacguisition 





Table 3. Reacguisition Time from [MOTO93-1] 


time obtained in experiments conducted as part of the research of this thesis. 


The PVT6 is capable of providing autonomous position, velocity, and time 
information over a serial RS-232 port. There are three different format types available for 
the data that can be selected by the user. These are the Motorola Binary Format, National 
Marine Electronics Association Standard (NMEA) Format 0183, and the LORAN 
Emulation Format. The Motorola Binary Format was chosen for use in the SANS because 
1t provides both satellite range information and position format messages. The following 1s 


a complete list of output message types available: 


29 


e Position/Channel Status 

e Satellite Range Data Output 

* Pseudorange Correction Output 
* Ephemeris Data Output 

* Visible Satellite Status 

e DOP Table Status 

* Almanac Status 

e Almanac Data Output 

* Leap Second Pending 


Each output message can be provided one-time or continuously at a selected rate, and 
stored for post-processing. The requested output options are stored in nonvolatile memory, 
and will remain in effect when the receiver is powered up again. This allows the user to 
select all desired options prior to a mission, and the receiver will remember those options 


until they are manually changed. [MOTO93-1] 


4. Compass 


The KVH C100 Multi-Purpose Digital Compass, shown in Figure 6, is a flux gate 
compass which provides three optional outputs. A 4 digit Binary Coded Decimal (BCD) 
serial stream formatted digital output is available, and both a linear and sine/cosine voltage 
signal analog output are available. Because the digital output would require an additional 
serial port connection to the E.S.P. 8680, the analog output is used. The analog output 
signal is processed through the A to D converter. The linear voltage output is proportional 
to the compass heading from 0.1 volts (000 degrees) through 1.9 volts (360 degrees). This 
voltage is converted to digital data by software triggered A to D conversion mode through 
the A to D converter. The analog signal from the compass is connected to the converter 


through one of 8 multiplexed input channels. This input channel is selectable at run-time 
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through software. The compass is 1.8 x 4.5 x 1.1 inches (8.91 cubic inches), weighs 2.0 


ounces, draws 0.1 W at 5 V dc current and is accurate to 40.5“. [KVH91] 





Figure 6. KVH C100 Multi-Purpose Digital Compass 


However, this accuracy only applies to a platform with a tilt angle of +169 if the 


compass is mounted to the platform, or +459 if the compass is mounted on a gimbal which 
suspends the compass in the horizontal plane. This would be acceptable for many AUVs, 
but not all. For example, a human diver or a dolphin (which constitute biological AUVs 


from the perspective of this research) would tend to dive and surface at angles greater than 


+459, Additionally, a gimballed system is susceptible to dynamic vibrations, shock and 
acceleration forces of the platform [HELL92]. These factors would not be critical for a 
| mechanical AUV that can only move and accelerate slowly, and that is restricted to very 
shallow climb angles. But, another type of sensor must be used to determine the heading 


for other types of AUVs. 


A solution to this problem is a strapdown sensor which provides three axes of 


magnetic measurement in a single package. The sensor is solid-state with the axes aligned 
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to the mechanical datum of the sensor case. Three-axis strapdown magnetometers provide 
better accuracy than a gimballed compass, and do not reguire restrictions on the tilt angle 
of the AUV. [HELL92] An example of this technology is the TCMI Electronic Compass 
Sensor Module from Precision Navigation. It contains a tri-axial magnetometer and a bi- 
axial electrolytic inclinometer in a 2.5 x 2 x 1.1 inch package [PREC94]. Another 
advantage of this sensor 1s that 1t provides compass heading and pitch and roll readings, in 


one sensor, which reduces the number of serial interfaces required in a system. 


5. Depth Transducer 


The Omega Inc. PX176-100S5V Depth Transducer, as seen in Figure 7, is a small 
cylinder 2 inches long and 1.5 inches in diameter (3.53 cubic inches), weighs 
approximately 5 ounces and has an operating range of 0 to 100 pounds per square inch of 
static pressure (PSIS). This equates to 6.7 standard atmospheres or 217 feet (67 meters) 
depth of sea water. Analog output is one to six volts dc. A to D conversion 1s performed by 


repetitive software triggered single A to D conversions in the same manner as the compass 
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Figure 7. Omega Depth Transducer 


92 


6. Accelerometer 


The Humphrey LA67-0108-1 Linear Accelerometer, seen below in Figure 8, 1s 
available in a measurement range of +0.5 to +1.5 G, 1s packaged as a small cylinder 1.8 
inches long and 1 inch in diameter (0.45 cubic inches), weighs 4 ounces, and provides 
accuracy to +5% of full scale with light vibration, applicable between 10 and 90% of full 
scale. The accelerometer measures acceleration using solid state silicon resistors which 


change electrical resistance in proportion to the applied mechanical stress. While this 
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Figure 8. Humphrey Accelerometer 


particular accelerometer is marginally acceptable with regard to accuracy, recent 


technology provides much more precise measurement in even small packages [GYR O92]. 


SOFTWARE DESCRIPTION 


| As developed and described in [STEV93] and [KWAK93], the SANS software 





esign has three major operations. These operations are: 


* Monitoring the AUV for a position fix request 


e Navigation data-logging for dead reckoning (DR) navigation (post-processed to 


determine the ascent vector) 
e (GPS data-logging for post-processed positional information 


AUV monitoring must be performed continuously during the mapping phase in 
anticipation of a reguest by the AUV to determine the position of an underwater object of 
interest. Monitoring of the AUV will be done using RS-232 serial line communication. 
GPS and dead reckoning navigation will remain inactive until the AUV reguests a position 
fix, then GPS will be powered. This allows the GPS receiver to be unpowered as much as 


possible to conserve battery power. 


The GPS receiver will be initialized with the proper receiver modes required for the 
mission. The Motorola Binary Format mode will be used, and the receiver will transmit 
both position/status and satellite range format messages at a one second rate. The computer 
will be configured to receive RS-232 serial communications with connection parameters 
specified from an input data file at run-time. The GPS output messages will be written to 
non-volatile memory on the host machine prior to real-time processing. The satellite range 
data will be stored for post-processing only. The position/status messages will be processed 
for navigation updates, and the position data will be used to determine the AUV”s current 


position using SPS and real-time differential processing. 


Submerged navigation in the SANS is accomplished by determining the direction 
and horizontal distance from the submerged object to the surfaced location using the depth 
change, heading and climb angle, as described in Chapter III, Section C. The outputs will 
be pitch attitude (or climb anglejand heading in degrees, and depth in meters, with a 
precision adequate to satisfy system accuracy requirements as stated in Chapter III, Section 
A. 

The interim SANS software programming language is Meridian Ada version 4.1.1. 
Assembly language is used for low level, high freguency operations in order to improve 
efficiency. An object-oriented design was chosen for the SANS because it allows for a 
simpler management of this complex system. Further explanation and software testing is 


described in [STEV93]. 
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D. SUMMARY 


The interim SANS design described in [STEV93] is the basis for the system 
described in this report. The use of gyroscopes in that system would reguire a limitation on 
the maximum climb and dive angle of the AUV to prevent gyro tumbling. Therefore, the 
research of this thesis explores replacing the gryos with a linear accelerometer to determine 
the climb angle of the AUV. Also, a recommendation for changing the compass to a three- 
axis magnetometer is made, because the compass would also require restricting the climb 
angle of the AUV. A new version of the E.S.P. 8680 core module and a new, smaller E.S.P. 
A to D converter replace those hardware pieces from the former system. The hardware for 
the SANS was chosen with the mission requirements in mind. Although there are many 
possible choices of off-the-shelf hardware for each part of the system shown in Figure 2, 
they all must be able to provide the accuracy required, as well as being able to meet the size, 
weight, power, and cost constraints of the proposed system. Therefore, possible systems 
which may provide better accuracy were not studied due to the increased cost. As further 
advances in miniaturization are made, the cost of this hardware will be reduced, making it 
easier to meet the baseline SANS requirements explained earlier. 

The software design described in [STEV93] is an object-oriented design 
programmed in Meridian Ada and assembly language. It 1s a modular system designed to 
make code reuse easy as the SANS hardware and software systems evolve. The software is 
broken down into the three logical primary operations of the mission, monitoring the AUV, 
navigation data-logging and GPS data-logging. Changes can be made to the objects and 


operations in the software as may be required for future research. 
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V. DEMONSTRATION SYSTEM TESTING 


A. INTRODUCTION 


The technical specifications of the hardware for the SANS, discussed earlier in 
Chapter IV and listed in Appendix A, were provided by the manufacturers of the 
equipment. This chapter will present the methods and results of experimental testing 
performed to determine the accuracy and speed of acquisition of the GPS receiver under 
various circumstances. Static testing was performed in an attempt to confirm Motorola”s 
specifications given in [MOTO93-1]. Additional static testing was performed to obtain data 
related to the time required for tracking three satellites after being powered off. This 
information is used to determine the time required before differential processing could be 


used to determine a more accurate position fix. 


In order to determine the extent of degradation of the GPS signal caused by standing 
water covering the antenna, a series of bench tests were performed. This was designed to 
relate to the effects of the wave wash under normal conditions at sea. Finally, an actual sea 
test was done to determine the effects of normal wave-wash over the GPS antenna, and 


executing frequent dives, while recording position and range data. 
B. STATIC TEST RESULTS 


The acquisition time and accuracy of the GPS receiver are the limiting factor in the 
overall accuracy of the SANS. Experimental static testing was performed to confirm the 
results presented in Chapter IV. To determine the acquisition time, or Time-To-First-Fix 
(TTFF) of the receiver in both hot and warm power-up States, samples were taken with the 
receiver off from 90 seconds to 6 hours. A GPS antenna was mounted on the roof of 
Spanagel Hall at the Naval Postgraduate School, at a known, surveyed location, nearly free 
of any signal obstructions. The GPS receiver was connected to this antenna, a PC, and a 
relay box. This relay box is used to interrupt the 12 volt main power supply to the receiver 


for a specified time. The receiver remained connected to the 5 volt battery or “Keep Alive” 
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power the entire time. This allowed the receiver to retain the real-time clock and the last 
known coordinates stored in RAM. 

The relay box used in this testing was controlled by a general serial I/O handler 
called GEORGE, written and developed by Dr. James Clynch. GEORGE is capable of 
providing various functions that act as a terminal emulator through a PC parallel port 
[CLYN92-2]. Control programs in GEORGE were written to send signals at specified 
times to the relay box. For example, in order to determine the TTFF of the GPS receiver 
after 90 seconds off, GEORGE would signal the relay box to turn on for 2 minutes, then 
turn off for 90 seconds, and loop. The receiver was set up to write position and range data 
to a file every second. This permitted recording of the acquisition time and the number of 
satellites tracked after power was returned to the receiver. The results of these tests are 


shown in Appendix C, and are summarized below in Table 4. The TTFF of the receiver is 


90 SECONDS OFF. 23.18 2389 3469 er 


10 MINUTES OFF 22.18 24.01 44.18 | 3c 
30 MINUTES OFF 23.97 27.05 32.95 BE 
1 HOUR OFF 28.79 35.83 Ti D 


3 HOURS OFF 24.46 EAD 41.80 


6 HOURS OFF 44.33 46.21 30.91 m 


Table 4. GPS Static Test Results Summary of Time-To-First-Fix 





fairly consistent through three hours off, which is the expected result since the ephemeris 
data is still current enough to be useful in acguiring satellites. The first fix position error is 


also fairly consistent, and consistent with the SPS level of performance. 
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Observing three satellites will provide two-dimensional position and velocity of the 
AUV. Therefore the acguisition time reguired to track three satellites, and the accuracy of 
the position data when tracking three satellites, are also extremely important information 
in assessing the overall accuracy of the receiver. The time reguired to obtain three satellites 
increases with the increase in power-off time. The mission reguirements are for the AUV 
to limit antenna exposure time to 30 seconds, with intervals between exposures of at least 
several minutes. The data in Table 4 indicates that these requirements can be met for update 
intervals of up to 30 minutes. The first fix from the testing showed that the accuracy of the 
receiver 1s well below the 100 m accuracy available using SPS. The receiver accuracy will 
not degrade the overall system accuracy. And with differential post-processing, the 


position error should be reduced to an accuracy of 2 to 4 meters. 
JA GPS BENCH TEST RESULTS 


As stated in Chapter III, during both the transit phase and the mapping phase of the 
mission, the AUV needs to be as difficult to detect as possible. Thus, the GPS antenna 
mounted on the top of the AUV must not protrude out of the water more than a few inches. 
With so little clearance above the surface, normal ocean waves would repeatedly cover the 
antenna for short periods of time. This wave-wash would typically last for only a few 
seconds at a time, but would occur continuously throughout the mission. One of the 
primary goals of this thesis was to determine whether the effect of the wave-wash would 
degrade the signal beyond use. In order to determine if the mission requirements could be 
met, it would have to be known whether a shallow layer of sea water covering the antenna 
would completely obstruct the GPS signal. As a preliminary step in determining this effect, 
a bench test was designed. A GPS antenna was mounted on a wooden platform, designed 
specifically for this test, at the height of the side supports. The platform side supports hold 
a plastic container, which was used because the plastic does not interfere with the GPS 
signal. The bottom of the container sat flush with the antenna. This test equipment is shown 


in Figure 9. The bench test was performed on the roof of Spanagel Hall, where there are no 
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Figure 9. Bench Test Equipment 


signal obstructions. The antenna was connected to the Motorola GPS receiver with 60 feet 
of RG-213 cable, and a laptop computer was used to control the receiver. In two of the test 
cases, there were only five satellites visible at the beginning of the test. The other two test 
cases started with the receiver tracking six satellites. With the receiver running, sea water 
was poured into the plastic container every two minutes. Each pour added a depth of 0.5 
mm of water over the antenna. The effect on the number of satellites tracked was recorded, 
along with the water depth, and which satellites were being tracked. A graph of the data 1s 


shown in Figure 10. This shows that a depth of between 3 and 5 mm of water can cover the 
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Deviation of 4 tests 


Average of 4 tests 


Satellites Tracking 





3 
Millimeters of Sea Water 
Figure 10. Bench Test Results 


antenna, and the receiver can still track at least three satellites for use in differential post- 
processing. In this test, the water was left covering the antenna continuously, until all GPS 
signals were lost. Because actual waves would wash over the antenna very quickly, 
reacquisition time for additional satellites after the wave recedes, would be very short, 


typically less than 3 seconds. 


Analysis of an elevation graph of the GPS satellites from the day of the test show 
that the satellites that the receiver was able to continue tracking, even with 4 - 6 mm of 
water covering the antenna, for those satellites that were at the highest elevation. The lower 
the elevation of the satellite during the test, the faster the signal was lost with water over 
the antenna. In two different tests, the receiver was able to continue to track one satellite 
with 11 mm of water covering the antenna. In both cases, that satellite was almost directly 
overhead the antenna during the test. The reason for this is due to the actual path of the 


signal underwater. As shown in Figure 11, when the antenna is covered by 5 mm of water, 
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39510 min 7 7.07 mm | 5 mm 
Figure 11. Diagram of Satellite Elevations with Effective Depth of Water 


if a satellite 1s overhead, the signal path travels 5 mm through the water. If the satellite is 


at 45? the path through the water is 7.07 mm. If the satellite is at 30“, the path travelled is 


10 mm. The effective depth of the water is the least when the satellite is directly overhead 


at 909. 

The antenna that was used for this test was the antenna that was included in the 
Motorola GPS evaluation kit, along with the receiver. This antenna module is a low-profile 
antenna with a protective housing that is 4.01 inches in diameter and 0.89 inches thick, and 
is the black antenna shown in Figure 12. There are various shapes and sizes of antennas that 
could be used. For testing purposes a relatively flat antenna was required to allow the water 
to sit over the antenna. However, for the baseline SANS, a fin-shaped antenna would 


probably provide better GPS accuracy and shorter acquisition times since more of the 
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antenna would be out of the water. A smaller. flat antenna could also be used for minimum 


detection. A sample of these antennas is shown in Figure 12. 


Antenna used ın 





Figure 12. Sample GPS Antennas 


D. SEA TEST RESULTS 


After establishing that the proposed mission requirements could be met based on 
the static tests and the bench tests, a sea test was developed. The purpose of the sea test was 
to further determine the ability of the GPS receiver to track satellites and obtain position 
and range data while the antenna was in the ocean. The first step of this test was to build a 
test vehicle that could be used as a limited simulation of an AUV, with the ability to float 
on the surface with the antenna just above the water, and with the ability to dive and surface 
as needed. A wooden platform was built, shown in Figure 13, which could be towed behind 


a boat, with a piece of metal attached to the rear that could be operated like an airplane 
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Figure 13. Sea Test Platform 


elevator by pulling on an attached line. This photo shovvs a preliminary test of the platform, 
with a wooden replica of an antenna mounted in the center. The sea test was performed by 
towing the platform behind a sailboat in Monterey Bay. This allowed a fairly constant 
speed in the water to properly control the platform, with no propeller interfering with the 


lines used to control the depth of the platform. 


The actual sea test was performed on a cool, sunny afternoon with NW winds at 4 
knots and 6 ft swells. The flat Motorola antenna that came with the GPS receiver was used 
for the actual test to evaluate the worst case, because the water can sit on top of it. The 
antenna was connected to the receiver on the boat, with 60 feet of RG-213 coaxial cable. A 
laptop computer was used to view and record the position and range data every second 
throughout the test. The test was also recorded on video tape to allow for later re-evaluation 


of the test along with the recorded data. 


Initially, the equipment was connected and turned on with the platform in the boat, 
and the receiver was able to track six satellites. For one hour and six minutes, the platform 


and antenna were towed behind the sailboat. The sea test maneuvers that were performed 
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were in the range of ocean wave occurrences that would be likely during the transit phase 
of the mission. The maneuvers that were performed and recorded for this test included long, 


deep dives to depths of 20 feet or more, such as that seen in Figure 14. During the long dives 





Figure 14. Typical Deep Dive 


the platform, with the antenna, was typically underwater for 1.5 - 3 minutes. This would be 


similar to a large wave crashing over the AUV. Figure 15 is a bar graph of three minutes of 
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Figure 15. Typical Deep Dive Tracking Results 


i Represents Antenna Surfacing 


the recorded sea test data. The time is in elapsed seconds beginning when the system was 
put in the water. Each bar shows the number of satellites that the receiver was tracking 
during that second of the interval. The bars with an arrow indicate that the antenna has 
surfaced. This graph shows two dives of about 1 minute each. The time to reacguire three 
satellites after surfacing was only 10 seconds in one case and 7 seconds in the other. The 


time to reacquire all six satellites was only 13 and 14 seconds. 


Short, shallow dives of 1 - 3 feet were performed and a sample can be seen in Figure 
16, where the typical time obscured was 20 - 60 seconds. This would be an example of a 
typical ocean wave, during the transit phase. An impulse graph of a typical shallow dive is 
shown in Figure 17, where it typically takes less than 10 seconds to reacquire at least three 
satellites after first fix. From this graph of the recorded data, the second interval can be used 
as a typical short, shallow dive. The antenna was submerged for 40 seconds. It took 6 


seconds after surfacing to track three satellites. 
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Figure 16. Typical Shallow Dive 
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Figure 17. Typical Shallow Dive Tracking Results 


à Represents Antenna Surfacing 
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Finally, very short, very shallovv repetitive dives vvere performed that vvould cover 
the antenna for just 2 - 5 seconds. An example of the bar graph of several short, shallow 


dives is shown in Figure 17. This graph shows that with a thin layer of water over the 
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Figure 18. Typical Very Short, Shallow Dive Tracking Results 


i Represents Antenna Surfacing 


antenna, it only takes 2 - 4 seconds to reacquire at least three satellites, if lock was ever lost 
at all during the submersion. Many times the receiver was able to continue tracking one or 
two satellites the entire time the water covered the antenna. This confirms that the GPS 
receiver can reacquire satellites quickly after the antenna has been covered by typical wave 


action. 


Since this test was performed with a flat antenna, a more curved antenna would be 
expected to provide even better results, if the mission could allow the additional risk of 
detection. Again, as was stated in relation to the bench test results, the satellites that 
remained fixed, and that were the first to reacguire during maneuvering, were the satellites 
with the highest elevation. Having at least one satellite overhead during the mission speeds 


up the first fix, which provides current ephemeris data for the receiver to find the other 
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satellites. Having more than one satellite overhead will greatly improve the acquisition time 


of the SANS. 


This sea test was designed with full knowledge of the limitations involved. 
Determining when the antenna was completely submerged was difficult due to the distance 
from the boat to the antenna. We were unable to determine the exact depth of the water 
covering the antenna. Therefore this test was primarily a subjective observation of the 
ability of the receiver to continue tracking satellites under typical ocean conditions. As a 


way of guantifying the data from the test, a graph of the sea test is shown in Figure 19. This 
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Figure 19. Probability of Tracking n Satellites 


graph shows the probability that the receiver was tracking at least n satellites, from n = 3 to 
n < 6, at any number of seconds after the antenna surfaced. These results show that, 
throughout the entire test, regardless of the submersion time, within 30 seconds after 
surfacing, there was over an 80% chance that the receiver was tracking at least three 
satellites. Therefore, a mission mapping phase that requires the AUV to remain submerged 
for up to 30 minutes, then allows for a surface time of 30 seconds should be attainable and 


should not be severely affected by normal wave action. Á mission transit phase that 


49 


reguires even shorter submerged times, and allows 30 second surface times, should be 


easily obtainable. 
E. SIMULATION RESULTS 


When the AUV finds an object of interest, it will be reguired to surface in order to 
obtain a GPS fix. This fix will give the location of the AUV on the surface, but to determine 
the location of the submerged object, as shown in Figure 1, it 1s necessary to calculate the 


horizontal distance travelled using 


AZ 
H = — Eq 9 
tan 0 1 


where AH is the horizontal distance travelled, AZ is the change in depth, and 0 1s the climb 
angle. In the SANS, the depth change is measured by the depth transducer. As stated ın 
Chapter III, using an accelerometer to determine the climb angle of the AUV would allow 
for removal of the gyroscopes that were evaluated in [STEV93]. The gyroscopes were 
determined to be unacceptable for this mission due to the constraint on the climb angle of 
the AUV required to prevent the gyros from tumbling. 

In the revised system concept, the accelerometer would be mounted to the 
navigation system along the longitudinal body axis of the AUV, because additional errors 
would be introduced if the velocity vector of the AUV deviates from the accelerometer 
measurement axis. As shown in Equation 2 through Equation 5 in Chapter III, the apparent 


climb angle of the AUV 1s calculated using the sensed acceleration and gravity, where 
sin (apparent —0) 2 sensed —acceleration/g Eq 10 
and the error between the sin of the actual climb angle and the sin of the apparent climb 
angle 1s: 
a/g = Sin (apparent — 8) — sin (8) Eq 11 
The horizontal error between the actual location and the expected location 1s calculated 


using Equation 12, where AZ is the change in depth of the AUV. 


] 1 
h tal — = 4| nta) Eq 12 
Mi tan (0) tan (apparent — 0) d 
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From these calculations, vve can determine vvhat the expected error vvill be from the 
accelerometer, given the actual climb angle, the change in depth and the acceleration, a, 


used by the AUV. 


These equations vvere included in a computer simulation of an AUV with a SANS. 
By giving the AUV climb angle and an acceleration profile, the simulation program 
function “calculate-error” will display the path of the AUV diving or surfacing, and 
calculate the horizontal error in meters. The acceleration profile is a list of lists, made up 
of the longitudinal acceleration and turning radius of the AUV, and the start and stop time 
of that segment in seconds. Each change in acceleration or turning radius reguires a 
separate list. The program will display a window with a “wire-frame” model of the AUV, 
which is redrawn at the end of each list from the acceleration profile, at the current location 
of the AUV. An X will mark the location where the AUV is estimated to be, based on the 


calculations. 


In a climb, initially the AUV would accelerate to its normal surfacing speed, 
maintain constant velocity for some time, then decelerate such that the velocity would be 
back to zero on the surface. Initially, during the accelerating portion of the climb, the 
horizontal error will be negative, that is the computed location is behind the actual location. 
During the time of constant velocity, since there is no acceleration, the apparent climb 
angle is egual to the actual climb angle, and there is no horizontal error. During the 
decelerating portion of the climb, the horizontal error will be positive, and the estimated 
location will be forward of the actual location. The error caused during deceleration will 
nearly cancel out the error caused during acceleration. The total horizontal error is a sum 
of the horizontal error created during each time interval and the error will be decreased 
significantly for the entire climb. This method will only be reguired for computing the 
horizontal distance travelled while climbing, so the errors will always be reduced by this 


combination of acceleration and deceleration. 


A number of simulations were run in order to provide the horizontal errors expected 


from the accelerometer under various conditions. These are shown below in Table 5. An 


acceleration of 0.98 m/sec? was used for these calculations, with a maximum velocity of 
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4.9 m/sec. The horizontal error is reduced further by reducing the acceleration and/or the 


maximum velocity of the AUV. 





Table 5. Sample Horizontal Error Calculations 


A sample of the simulation display is shown in Figure 21, which shows the path of 
the actual location of the AUV, and the Xs show the estimated location based on the 


calculations shown in this chapter. This display is a side view of the AUV during the climb. 


In this sample acceleration profile, the AUV will accelerate at 0.98 m/sec" for the first 5 
seconds of the climb, reaching a maximum velocity of 4.9 m/sec. Then the AUV will 


maintain a constant velocity for 35.5 seconds, and finally, will decelerate for 5 seconds at 


-0.98 m/sec?. This profile 1s displayed in Figure 20. 


Profile — 


Velocity m/sec 





Seconds 


Figure 20. Profile of Sample AUV Surfacing 
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These calculations show that the total horizontal error introduced by using an 
accelerometer to calculate the climb angle, and determine the horizontal distance travelled, 
is minor, and will not significantly effect the ability of the SANS to obtain an accuracy of 


10 meters rms or better. 


F. SUMMARY 


This chapter provides an explanation of the experimental tests that were developed 
and performed to determine how a navigation system using GPS would perform under the 
conditions required by the mission as described in Chapter III. It also explains the computer 
simulation used to determine the accuracy of the measurement of horizontal distance 
travelled by the AUV from a submerged object to the surface. The distance is calculated 


based on using an accelerometer to determine the climb angle of the AUV. 


Static testing was done to confirm the acquisition time and accuracy of the Motorola 
GPS receiver required to track the first satellite, and determine the time required to track 
three satellites. This provides information needed to assess the ability to use differential 
processing. The static tests show that the receiver 1s able to acquire a first fix, with three 
satellites tracked, within the required 30 seconds, when the receiver is off for 30 minutes 
or less. The accuracy of the receiver 1s well within the 100 meter accuracy level of Standard 


Positioning Service (SPS). 


The mission of the AUV requires that the SANS and the antenna mounted on the 
AUV are as undetectable as possible in order for the mission to remain covert. This means 
that the antenna must not protrude out of the water more than a few inches. Therefore, 
normal wave activity of the ocean will repeatedly cover the antenna with a thin layer of 
water for short periods of time whenever the AUV is surfaced. To determine whether this 
layer of water would degrade the GPS signal beyond use, a bench test was performed. This 
bench test showed that the receiver was able to continue tracking at least three satellites 
while the antenna is continuously covered with 3 to 5 mm of sea water. When the water 
obstructs the signal for a short time, and is removed, such as a wave would, the receiver 1s 


able to reacquire additional satellites within 3 - 5 seconds. The antenna used for testing was 
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a flat antenna which would allow water to sit on it. Using a fin shaped antenna would 
improve the ability of the receiver to continue tracking since less of the antenna would be 
covered at any time. Also, the testing showed that the higher the elevation of the visible 
satellites, the better the receiver was able to continue tracking, even with 5 to 11 mm of 


water covering the antenna. 


As a final test to demonstrate the ability of the SANS to operate in its proposed 
environment, an actual sea test was performed on the antenna and receiver. This sea test 
used a wooden tow-body, towed behind a sail boat, that could be controlled to float on the 
surface of the water, be towed just under the surface, or be made to dive to various depths. 
The antenna was mounted on the float, and connected to the receiver with RG-213 cable. 
The entire test was recorded on video tape and the position and range data from the receiver 
was written to a file for evaluation. During this sea test, various lengths and depths of dives 
were performed as samples of the various types of waves that could effect the GPS signal 
during the transit phase of the AUV mission. Each of these dives, from very short to long, 
deep dives, showed that overall, the receiver was able to reacguire the GPS signal and track 
at least three satellites during over 80% of the time. The receiver was typically able to 


reacguire three or more satellites within 10 to 12 seconds after surfacing. 


A computer simulation was used to determine the error introduced by using the 
sensed acceleration from an accelerometer in the SANS to calculate the climb angle of the 
AUV when climbing from a submerged object of interest back to the surface. This climb 
angle was then used to calculate the horizontal distance travelled from the object to the 
surface, to determine the actual location of the object. The simulation results shown in 
Table 5 are a sample that illustrate that the horizontal error introduced is minor. Because 
the AUV is accelerating and decelerating during the climb, the positive and negative 
location errors tend to cancel each other, and the horizontal error would not significantly 
reduce the accuracy of the SANS. Additionally, by reducing the acceleration and maximum 


velocity of the AUV, the horizontal error is reduced further. 


This combination of experimental testing and simulation show that the hardware 


configuration as described in Chapter IV is able to meet the reguirements for the transit 
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phase and the mission phase. The AUV is able to remain covert, spend no more than 30 
seconds on the surface during each interval, have the antenna exposed only a few inches 
above the surface, allow a submerged time of up to 30 minutes, and obtain an overall 
accuracy of 10 meters rms or better. These tests also show that the effects of normal waves 
of the ocean should not significantly degrade the capability of the navigation system. The 
simulation results show that replacing gyroscopes with an accelerometer should not 


degrade the capability of the system either. 
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VI. LISP SIMULATION CODE DESCRIPTION 


A. INTRODUCTION 


A very basic computer simulation of an AUV and the SANS from this research vvas 
designed in order to improve the ability of researchers to test various theories involved in 
the design of the SANS. Replacing the gyroscopes in the SANS used to measure the climb 
angle of the AUV when surfacing, with an accelerometer was proposed by Prof. McGhee 
in [MCGH93]. This change would require using the acceleration sensed by the 
accelerometer to calculate the climb angle of the AUV. As discussed previously, this 
method would introduce error into the final computation of the horizontal distance travelled 
by the AUV from a submerged object back to the surface. In order to reduce the time and 
effort required to compute this error, the equations needed were included in the software 
for the simulation. By using the simulation, with the required parameters, the expected 


horizontal error can be quickly and easily determined. 


The simulation was written in CLOS (Common LISP Object System), which 
provides an object oriented programming design. Because the SANS is made up of many 
parts, an object oriented programming language is preferred. CLOS allows the AUV and 
the SANS to be represented as objects and classes, and each sensor within the SANS has a 
slot which contains the measurements for that sensor. Another advantage to using CLOS is 
that it is an interpretive language. This makes it very simple for the programmer and user 
to determine at any time what the status of the objects and their slot values are. This chapter 
explains the Hunter simulation code. The basis for this simulation was an Aguarobot 
walking machine simulation that was written by Prof. McGhee, and is described in 


[DAVI93]. 


B. CLASS AND OBJECT HIERARCHY 


Object oriented programming allows a complex system to be designed as a group 


of elementary components that are linked together as reguired by the system. This is done 
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using classes and objects. Classes are the blueprints or forms for a component, while 


objects are the components that can be manipulated using the software program. [DA VI93] 


A class provides the template for creating many objects. The class provides the 
correct information, in each slot, required for that class. A class can inherit from multiple 
superclasses, giving it the information from the slots of all of it's superclasses. An abstract 
class is designed as a template which can contain information needed by multiple 
subclasses. This multiple inheritance reduces the amount of duplicated information. An 
abstract class cannot have an object instantiated. Only concrete classes have objects 


instantiated from them. [DA VI93] 


An object is made from the instantiation of a concrete class. All objects from the 
same class have the same slots, although they can all be manipulated individually after 
instantiation. Each object is created by making an instance of the class, and each object has 


its own name within the program. 


Es HUNTER CLASS DEFINITION CODE 


The rigid body class is used as a superclass for the Hunter simulation. The hunter 
is a subclass of rigid body made up of an AUV and a SANS. The AUV, called dolphin in 
this simulation, is made up of a dolphin body, a dorsal fin, a right pectoral fin, a left 
pectoral fin, and a tail fin, all of which are separate subclasses of rigid body. The fins are 
attached to the body using the /ink class. The SANS is also attached to the body using the 
link class, but the SANS uses linkO and link/, and the fins use link2 and link3. The class 


hierarchy is shown in Figure 22. 


Classes in CLOS are written according to a template with mandatory and optional 
information. The CLOS classes allow the use of slots for the items within a class. These 
slots are defined and initialized using the :initarg or :initform command. Figure 23 shows 
a sample of code for the dependent objects instantiated within the abstract dolphin-fin class. 
The make-instance command is used to instantiate objects, such as /ink2. Functions related 


to the class are defined outside of the class definition in defmethods. The “initialize-fin” 
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function requires a fin and a dolphin-body as input. Functions can be used to change slot 


values, call other functions, and assign variables. [DAVI93] 
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Figure 22. CLOS Hunter Class Hierarchy 
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(defclass dolphin-fin () 
((fin-attachment-angle 
“initarg :fin-attachment-angle 
:accessor fin-attachment-angle) 
(link2 
:initform (make-instance 'link2) 
:accessor link2) 
(link3 
cinitform (make-instance 'link3) 
:accessor link3) 
(motion-complete-flag 
:initform nil 
:accessor motion-complete-flag ) 
(previous -fin-position 
cinitform nil 
:accessor previous-fin-position) 
(current-fin-position 
initform nil 
:accessor current-fin-position))) 


(defclass right-fin (dolphin-fin) 
((link2 :initform (make-instance ‘link2 
:link-length 22 
:twist-angle (deg-to-rad 90) 
:inboard-joint-displacement 1 )) 
(link3 :initform (make-instance ‘link3 
:node-list '((0O O 1) (0 10 10 1) (44 300 1) (0 0 40 1)))))) 


(defmethod initialize-fin ((fin dolphin-fin) (aqua dolphin)) 
(setf (inboard-link (link2 fin)) (body aqua)) 
(setf (inboard-link (link3 fin)) (link2 fin)) 
(rotate-link (link2 fin) (fin-attachment-angle fin)) 
(rotate-link (link3 fin) (inboard-joint-angle (link3 fin))) 
(setf (current-fin-position fin) 
(firstn 3 (first (transform-node-list (link3 fin)))))) 


Figure 23. CLOS Code Excerpt Defining and Implementing 
Dolphin Fin Kinematics 


60 


D. HUNTER OBJECT INSTANTIATION CODE 


The object hierarchy of the simulation is shown in Figure 24. It has one top level 


object, the hunter, with the dependent objects as shown. 
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Figure 24. CLOS Object Hierarchy 
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The hunter simulation creates a hunter object by performing the function “make- 
hunter-picture”, as seen in Figure 25. This will make an instance of a hunter, with a dolphin 
and a SANS, initializes the hunter which will initialize its dependent objects, make an 
instance of an X to mark the error location, make an instance of a camera, and take a picture 
of the hunter. Even though every hunter is created exactly alike, each one has a different 


name within the program and can be manipulated separately. 


(defclass hunter () 
((dolphin 

:initform (make-instance 'dolphin) 
:accessor dolphin) 

(sans 
'inifform (make-instance 'sans) 
:accessor sans) 

(node-list 
initform '((0 0 O0 1)) 
:accessor node-list))) 


(defmethod initialize ((huntl hunter)) 
(setf delta-t (get-delta-t (sans huntl ))) 
(initialize (dolphin huntl )) 
(initialize-sans (sans hunt1) hunt1) 
(setf (node-list huntl ) (append (node-list (dolphin huntl )) 
(node-list (linkl (sans huntl ))))) 
(update-velocity-growth-rate hunt! ) 
(transform-node-list hunt! )) 


(defmethod make-hunter-picture () 
(setf huntl (make-instance ‘hunter)) 
(initialize hunt!) 

(x-picture) 
(setf caml (make-instance 'camera)) 
(take-picture caml huntl )) 


Figure 25. CLOS Code for Hunter Class 


The dependent objects dolphin and SANS, that are part of the top-level object 
hunter, and their dependent objects, are created automatically within the code when an 


instance of hunter 1s created. Because they are dependent objects, they cannot be referred 
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to without referring to them through the hunter, and they are all destroyed when the hunter 
is destroyed. A sample of code showing the class definition for the dependent object 


dolphin 1s shown in Figure 26. 


(defclass dolphin () 

((body 
initform (make-instance 'dolphin-body) 
:accessor body) 

(right-fin 
:initform (make-instance “right-fin :fin-attachment-angle (deg-to-rad 90)) 
:accessor right-fin) 

(left-fin 
:initform (make-instance “left-fin :fin-attachment-angle (deg-to-rad -90)) 
:accessor left-fin) 

(dorsal-fin 
“initform (make-instance “dorsal-fin :fin-attachment-angle 

(deg-to-rad 90)) 

:accessor dorsal-fin) 

(tail-fin 
:initform (make-instance 'tail-fin :fin-attachment-angle (deg-to-rad 0)) 
:accessor tail-fin) 

(node-list 
initform '((0 0 0 1)) 
:accessor node-list))) 


Figure 26. CLOS Code for Dolphin Class 


E. SIMULATION CODE 


In order to calculate the climb angle of the AUV in the Hunter simulation, a number 
of functions had to be written. These functions perform the same calculations as those 
shown in Eguation 9 through Eguation 12, in Chapter V. A sample of the functions is shown 
in Figure 27. “Set-accelerometer” performs the calculations in Equation 13 and Equation 


14, while “update-horizontal-error” performs the calculation in Equation 15. 


sensed —acceleration = a+gsin (9) Eq 13 

sin (apparent—9) = sin (8) +a/g Eq 14 

Ahorizontal — error= Mas - —— 3) Eg 15 
tan (8) tan (apparent— 0) d 
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(defmethod set-accelerometer ((huntl hunter)) 

(setf (sensed-acceleration (sans huntl )) 

(+ (first (velocity-growth-rate (sans hunt1))) 

(* *gravity* (sin (deg-to-rad (climb-angle (sans huntl ))))))) 
(setf apparent-climb-angle 

(rad-to-deg (asin (+ (sin (deg-to-rad (climb-angle (sans hunt! )))) 

(/ (first (velocity-growth-rate (sans hunt1))) "gravity"))))) 

(update-horizontal-error hunt! )) 


(defmethod update-horizontal-error ((huntI hunter)) 
(setf (horizontal-error (sans huntl )) 
(* (delta-depth (sans huntl )) 
(- (11 (tan (deg-to-rad (climb-angle (sans huntl ))))) 
(/ 1 (tan (deg-to-rad apparent-climb-angle))))))) 
Figure 27. CLOS Code Excerpt Showing Functions Used to 


Calculate Climb Angle 


In order to compute the estimated horizontal error introduced by using an 
accelerometer to determine the climb angle of the AUV, the hunter simulation requires the 
user to assign an acceleration profile and provide the climb angle used for surfacing. An 
example of this is shown in Figure 28. The acceleration profile is made up of a list of lists. 

(setf profile-2070 ((0.98 -40 5) (0 -4 5 10) (0 -4 10 15) (0 4 15 20) 


(0 -4 20 25) (0 4 25 30) (0 4 3035) (0 -4 35 40.5) 
(-0.98 4 40.5 45.5))) 


(calculate-error-demo '-20 profile-2070) 


Figure 28. Sample User Input Reguired to Calculate 


Horizontal Error 


The first element in the list, 0.98 in this example, is the acceleration, in m/sec?, of the AUV 
during that time period. The second element is the turn radius of the climb, -4 m. The third 


and fourth elements are the start and stop times in seconds for that portion of the profile. In 


this sample the AUV will accelerate at 0.98 m/sec? for the first 5 seconds of the climb, 
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reaching a maximum velocity of 4.9 m/sec. Then the AUV vvill maintain a constant velocity 
for 35.5 seconds, after which it will decelerate for 5 seconds at -0.98 m/sec?. The function 


calculate-error-demo provides the climb angle for the climb of -20%, and the desired 
acceleration profile. In this example the AUV climbed 68 m. This simulation uses the 
standard coordinate system used in aerodynamics, with positive z being down, and negative 


z being up. 
F. GRAPHICS DISPLAY 


The graphical display in CLOS is created using an object called a camera. It was 
created as a debugging tool [DAVI93], and in this simulation it can be used to visually 
demonstrate the horizontal error at each stage of the climb. The wire-frame diagram of the 


hunter, with a dolphin and a SANS is shown in Figure 29 as it would appear on the screen. 





Figure 29. Graphical Display of a Hunter 


The design of the wire-frame diagrams of the objects is determined by the node list and 
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polygon list for each object. These are used to draw the object. Figure 30 is an example of 
the node list used to draw the SANS. Each point is given in centimeters, and the simulation 


bases the local coordinate system origin on the center of the dolphin body. 


(defclass sans (rigid-body) 
((link] 

:initform (make-instance linki In centimeters 

:node-list '((0 0 0 1) 
(25 10 -22 1)(37 IO TI V O O SU 
(25 -10 -22 1) (37 -10 -22 1) (37 -10 -30 1) (25 -10 -30 1) 
(37 10 -22 1) (37 -10 -22 1) (37 -10 -30 1) (37 10 -30 1) 
(25 10 -22 1) (25 -10 -22 1) (25 -10 -30 1) (25 10 -30 1) 


(25434530 11025102002 a2 ni 
(313 301 )(31 4 SOL IE ON, 


(25 3 -30.1)(31 SEGLES EE EE 
(25-330 1) (31 SS e gel) 
(25 2 -33 1) (31 2 -33 1) (28 0 -44 1) 

(31 2 -33 1) (31 -2 -33 1) (28 0 -44 1) 

(38 -33 1) (25-2 -33 1) 280-44 1) 

(25 -2 -33 1) (25 2 -33 1) (280 44 1)) 


:polygon-list '((12 3 4) (5 6 7 8) (9 10 11 12) (13 14 15 16) (17 18 19 20) 
(21 22 23 24) (25 26 27 28) (29 30 31 32) (33 34 35) (36 37 38) 
(39 4041) (42 43 44)) 


:min-joint-angle '0 
:max-joint-angle '0) 
:accessor linkl ))) 


Figure 30. CLOS Code Excerpt Showing Node List of SANS 


The camera can be moved to obtain views of the hunter from various angles, and 
the movement of the dolphin and its fins can be seen on the screen. Because CLOS is an 
interpreted language, the user can see each change or movement of the objects as they are 
entered into the command line. A complete listing of all simulation code used in this thesis 


Is provided in Appendix B. 
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G. SUMMARY 


In order to increase the ability to test and evaluate the SANS, a computer simulation 
of the system was developed, called a Hunter. As described in Chapter V, this simulation 
currently has the capability to determine the estimated errors introduced by using an 
accelerometer to measure acceleration and thus calculate the climb angle, and the 
horizontal distance travelled by an AUV from a submerged object to the surface. This 
would be used to determine the actual location of the object, from the GPS location 


obtained after surfacing. 


The hunter computer simulation is written in CLOS, and is made up of classes and 
objects as would be logical for the design of a system comprised of an AUV, called dolphin 
in this simulation, and a SANS. The hunter is the top-level object. The dolphin and the SANS 
are comprised of objects as well, and each have slot values that are assigned when created. 
The slot values in the SANS are used to store information that would be available from 
various sensors in the actual SANS. For example, the SANS has a slot called sensed- 
acceleration, which would be a reading from the accelerometer. The class and object 


hierarchy and sample code for defining and instantiating classes and objects are shown. 


The function “calculate-error” uses the series of equations previously shown to 
calculate the horizontal error expected from the use of an accelerometer in the SANS. 
Sample code of these equations is provided. The user must provide an acceleration profile 
for the AUV to use for the simulation of a climb, as well as the climb angle. This will 
require providing the expected acceleration rate of the AUV, the maximum velocity 
reached and the expected deceleration rate, as well as the duration of each of these events 


during the surfacing maneuver. 


In order to better explain and understand the expected actions and responses of the 
AUV and SANS, a graphical display of the objects is included in the simulation. This 


allows for viewing a simulation of the AUV performing a desired climb. 
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VII. CONCLUSIONS AND RECOMMENDATIONS 


A. CONCLUSIONS 


The mission reguirements for the Small Autonomous Underwater Vehicle (AUV) 
Navigation System (SANS) were outlined in Chapter I. The hardware testing performed in 
this research was done in order to determine whether the mission reguirement for having 
the GPS antenna at the surface of the ocean while limiting visibility would degrade the 
ability of the GPS system beyond use. The mission does not allow the antenna to protrude 
out of the water more than a few inches. Therefore, due to normal surface waves, the 
antenna will usually be wet, and will repeatedly be covered with water for short periods of 
time throughout the mission of the AUV. This research performed a series of experimental 
tests that show that the GPS signal is able to penetrate a shallow layer of sea water when it 
is covering a GPS antenna, and that the normal wave wash from the ocean should not 
significantly degrade the ability of the system to obtain a GPS fix within 30 seconds of 
surfacing. During the mission phase, the AUV must be able to submerge for several 
minutes at a time and still be able to obtain a GPS fix within 30 seconds after surfacing. 
The hardware testing described in Chapter V show that the GPS system is capable of 
meeting this requirement. 

The miniature gyroscopes used in the SANS design described in [STEV93] needed 
to be replaced because the AUV climb angle would have to be limited to prevent gyro 
tumbling. In order to determine whether an accelerometer could be used in the system to 
determine the climb angle, as described in [MCGH93], extensive error calculations had to 
be performed. To simplify the process of calculating these errors, a graphical computer 
simulation was written in CLOS (Common LISP Object System). After finding an object 
of interest the AUV will be required to surface to obtain a GPS fix. The climb angle of the 
surfacing is used to determine the position of the object based on the GPS fix. This 
computer simulation determines the horizontal error that is the difference between the 
actual location of a submerged object to the position that the SANS sensors expect the 


object to be. The simulation is run using various surfacing profiles, based on an 
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acceleration profile that gives the acceleration and turn radius for each second of the 
surface. The results of this simulation show that the error introduced from the 
accelerometer do not greatly reduce the accuracy of the SANS, and that it could be used to 
replace the gyroscopes thereby removing restrictions on the climb angle of the AUV. 

AM of the hardware components described in this thesis meet or exceed the 
requirements for the mission. This research concludes that all of the mission objectives can 


be met using the current SANS design. 


B. RECOMMENDATIONS 


1. Future Research 


Recommendations for future research on the SANS project fall into two categories, 
software and hardware. The next phase in the software development is to implement and 
evaluate the software design from [STEV93] on the E.S.P. 8680. The next phase in the 
hardware development is to test the system using differential GPS, either real-time or with 


post-processing, to determine the accuracy of the differential system. 


Additionally, the new, high performance, low-power TCM1 Electronic Compass 
Sensor Module developed by Precision Navigation could be included in the SANS. It is 
based on a triaxial magnetometer system and a biaxial electrolytic inclinometer. Developer 
specifications show that this system should be able to meet all mission requirements. 


[PREC94] 


2. Future Use of Code 


The Computer simulation written for this research could be further developed for 
other purposes. New sensors could be added to the program to determine their expected 
accuracy. Forces of motion on the rigid body could be added to improve the realism of the 
simulation. The AUV shape and size can be changed easily, as can the acceleration, 
velocity and climb angle. These changes could be made to adapt the program to other types 


of AUV missions. 
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APPENDIX A: TECHNICAL SPECIFICATIONS 


A. DOVATRON ESP-8680 CORE MODULE 


Processor: 
Serial Port: 


Reyboard: 


Graphics: 


Memory: 


Memory Option: 
Bus Interface: 


Form Factor: 


Power Consumption: 


14 MHz 5-volt 8680 (8086 eguivalent) 
RS-232 


Standard controller and direct key switch 
matrix scanning 


CGA (Color Graphics Adapter) or 
LCD (Liquid Crystal Display) 


256K x 8 EPROM or Flash Memory 

512K or IMB DRAM (8-bit or 16-bit 

wide memory path) 

PCMCIA card slot for up to 16MB Memory 
Expansion board adds up to 16MB DRAM 
ISA (Industry Standard Architecture) 

1.7" x 5.1" (13.2cm x 4.3cm) 

Draws from 1 mA (sleep mode) to 350 mA 


(peak load powering back-lit LCD and 
peripherals) 
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B. DOVATRON E.S.P. A TO D CONVERTER 


Input channels: 

A/D resolution: 
Input ranges: 
Programmable Gain: 
Sample Rate: 
Resolution: 
Measurement: 


RMS Mode: 


Other features: 


Povver Requirements: 


16 single-ended or 8 differential 
12-bits (1/4096) 
1.25 mV to 10V 
1 - 8000 (one binary and one decade PGA) 
333 KHz Maximum (single channel) 
20 microvolt minimum 
AC/DC Coupling, True RMS 


Accuracy 1% above 20 KHz, 250 mSec 
response, 100 KHz BW 


82C54 Three channel programmable timer. 
One channel available for general use. 
Offset voltage trimmer. 


TBD 
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MOTOROLA PVT-6 


Receiver Architecture: 


Iracking Capability: 
Dynamics: 


Antenna to Receiver 
Interconnection: 


Serial Output: 
Accuracy: 


Operating Temperature: 


Humidity: 
Physical Dimensions: 


Weight: 
Switched Power: 
Keep-Alive Power: 


6-channel 
L1 1575.42 MHz 


6 simultaneous satellite vehicles 
Velocity : 1000 Knots (514.4 m/sec) 
Acceleration: 4 g 

Jerk: 5 m/s? 


Single coaxial cable 

(6dB max loss at L1; 1575.42 MHz) 
Typical length with RG58 coaxial cable; 
20 feet (6 meters) 


RS-232C Interface 

Less than 25 meters, SEP (without SA) 
-30°C to +80°C 

95% non-condensing +30°C to +60°C 
3.94 x 2.76 x 0.65 in 

(100 x 70 x 16.5 mm) 


4.5 ounces (128 grams) 
9 to 16, Vdc or5 0.25 Vdc 
4.75 - 16 Vdc; 0.3 mA 


Power Consumption (typical):1.3 W (0 5 Vdc input 


MTBF 
Acquisition Time 


(Time To First Fix, TTFE) 


Reacquisition Time: 


18 W o 12 Vdc input 


:65,000 hours (estimated) 
:Hot: 21 sec. typical TTFF 
Warm: 53 sec. typical TTFF 


15 sec obscured: < 2.5 sec. typical 
30 sec obscured: < 3.5 sec typical 
45 sec obscured: < 3.5 sec typical 
60 sec obscured: < 3.6 sec typical 


> 


D. RVH C100 DIGITAL COMPASS SENSOR 


Accuracy: 
Repeatability: 
Resolution: 


Dip Angle: 


Tilt Angle: 


Electrical Power: 


SIZe: 

Weight: 

Environmental Performance: 
Operating Temp.: 
Vibration: 


Shock: 


Digital Interfaces: 


Analog Outputs: 
Sine/Cosine: 


OR 


Linear Voltage: 


+0.5% or +10 mils RMS 
4) 29 ar +5 mils 
0.19 or 5 mils 


+809 Maintains stated accuracy after 
autocal over +809 Magnetic Dip Angle 


+169 Dev.= +0.39 RMS 
+459 Dev.= +0.59 RMS 


Input Voltage: +8 to +20 VDC or 
+20 to +30 VDC 
(user selectable) 


Current Drain: 20 mA DC; nominal 


1.80 x 4.50 x 1.10” 
(4.6 cm x 11.4 cm x 2.8 cm) 


2.0 ounces (57 grams) 
-22° to +122°F 
(-30°C to +50°C) 


30 minutes random 
MIL-STD-810 


Handling shock per 
MIL-STD-810 


Standard RS232 Bidirectional Serial Data 


Sine/Cosine output voltage 
42.5 V £1.0V 


0 to +3.6 VDC into 10K 
Ohm minimum load 
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E. OMEGA PX176-100PSIS DEPTH TRANSDUCER 


PX176 Specifications at 25%C 


Full Scale Output 4.90 4.95- | 5.10 Vdc 
(FSO) @ 25°C 5.05 
1 .05 


Linearity Bso] lež [zs | PSO 


Temperature Error +01 |+02 | %FSO/*C 
Null 0° to 85°C 


sem ee | mb - 

-55° to 0°C +85°C to 105°C | [£00 | IZ A 
amaga [| =. 
rene Rpm | tl = 
Bere Pl! Pt 


Supply Current (Ouiecent) 


Operating Tempurature a 105°C R 


FSO is the voltage change between minimum and rated pressure. 
For example: NOM Vo = 1.00 V @ Null Pressure, NOM Vo = 6.00 V @ Rated Pressure, 
FSO = (6.00 - 1.00) = 5.00 V. 





Range: 


Undamped Natural Freguency: 


Damping Factor: 


Potentiometer Resistance: 


Power Dissipation: 
Noise: 
Resolution: 


Accuracy: 


Static Threshold: 


Insulation Resistance: 


Temperature: 
Non-Operating: 


Operating: 
Acceleration: 
Shock: 


Sinusoidal Vibration: 


Sealing: 
Service Life: 


Weight: 


HUMPHREY LA67-0108-1 LINEAR ACCELEROMETER 


+0.5 to +1.5 G 

11.5 Hz approximately 

1.3 € 03 of Critical at -259C 
5000 Ohms +10% 

0.5 W maximum 

2.0% full scale maximum 
0.1% full scale maximum 


+5% of full scale (with light vibration) 
applicable between 10 and 90% full scale 


0.15 G maximum 

50 Megohms min. between all isolated 
circuits and between any terminals and 
case when measured with 500 Vdc at 
standard atmospheric conditions 
-80°F to +160°F 

-65°F to +160°F 

15 Gin each axis 

15 G, 11 msec duration 

0.02 inch D.A., 5 to 11 Hz; 

0.13 G, 11 to 44 Hz; 

2 G, 44 to 500 Hz 

Hermetic 


25 x10. cycles minimum 


4 ounces 
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APPENDIX B: SIMULATION CODE 


& Xcamcra.cl ** 
(require :xCw) 
(cw:initialize-common-windows) 


(defclass camera (rigid-body) 
((focal-length 
:accessor focal-length 
:Initform 6) 
(posture 
:accessor posture ;azmelev rollx yz 
:initform (list 0 0 0 -300 0 0)) 
(camera-window 
:accessor camera-window 
:Initform (cw:make-window-stream :borders 5 
:left 100 
:bottom 300 
:width 900 
:height 400 
‘title “Dolphin” 
:activate-p t)) 
(H-matrix 
'initform (homogeneous-transform (deg-to-rad -90) 0 0 0 300 0)) 
(inverse-H-matrix 
:accessor inverse- H-matrix 
:Initform (inverse-H (homogeneous-transform 
(deg-to-rad -90) 0 0 0 300 0))) 
(enlargement-factor 
:accessor enlargement-factor 
:Initform 30))) 


(defun create-camera-1 () 
(setf camera-1 (make-instance 'camera))) 


J 


: xxx Draw picture functions Ek EE N EE N EE EE EE RE E E E E E E OK OK OK OK OK OK N RR N K K K N kK k k kK 


(defmethod take-picture ((camera camera) (body rigid-body)) 
(let ((camera-space-node-list (mapcar #’ (lambda (node-location) 
(post-multiply (inverse-H-matrix camera) node-location)) 
(transformed-node-list body)))) 
(dolist (polygon (polygon-list body)) 
(clip-and-draw-polygon camera polygon camera-space-node-list)))) 


(defmethod erase-camera-window ((camera camera) ) 
(cw:clear (Camera-window camera) )) 


(defmethod cam! () 
(setf cam1 (make-instance 'camera))) 


(defmethod clear ((camera camera)) 
(cw:clear (camera-window camera))) 


(defmethod flush ((camera camera)) 
(cw:flush (camera-window camera))) 


(defmethod new-picture ((camera camera) (body rigid-body)) 
(erase-camera-window camera) 
(take-picture camera body)) 


(defmethod clip-and-draw-polygon 
((camera camera) polygon node-coord-list) 
(do* ((initial-point (nth (first polygon) node-coord-list)) 
(from-point initial-point to-point) 
(remaining-nodes (rest polygon) (rest remaining-nodes)) 
(to-point (nth (first remaining-nodes) node-coord-list) 
(1f (not (null (first remaining-nodes))) 
(nth (first remaining-nodes) node-coord-list)))) 
((null to-point) 
(draw-clipped-projection camera from-point initial-point)) 
(draw-clipped-projection camera from-point to-point))) 
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(defmethod draw-clipped-projection ((camera camera) 
from-point to-point) 
(cond ((and (<< (first from-point) (focal-length camera)) 
(<< (first to-point) (focal-length camera))) nil) 
((<= (first from-point) (focal-length camera)) 
(draw-line-in-window camera 
(perspective-transform camera 
(from-clip camera from-point to-point)) 
(perspective-transform camera to-point))) 
((<= (first to-point) (focal-length camera)) 
(dravv-line-in-vvindovv camera 
(perspective-transform camera from-point) 
(perspective-transform camera 
(to-clip camera from-point to-point)))) 
(t (draw-line-in-window camera 
(perspective-transform camera from-point) 
(perspective-transform camera to-point))))) 


(defmethod from-clip ((camera camera) from-point to-point) 
(let ((scale-factor (/ (- (focal-length camera) (first from-point)) 
(- (first to-point) (first from-point))))) 
(list (+ (first from-point) 

(* scale-factor (- (first to-point) (first from-point)))) 

(+ (second from-point) 
(* scale-factor (- (second to-point) (second from-point)))) 

(+ (third from-point) 
(* scale-factor (- (third to-point) (third from-point)))) 1))) 


(defmethod to-clip ((camera camera) from-point to-point) 
(from-clip camera to-point from-point)) 


(defmethod draw-line-in-window ((camera camera) start end) 
(cw:draw-line (camera-window camera) 
(cw:make-position :x (first start) :y (second start)) 
(cw:make-position :x (first end) :y (second end)) 
:brush-width 1)) 


Jej 


(defmethod perspective-transform ((camera camera) point-in-camera-space) 
(lett ((enlargement-factor (enlargement-factor camera)) 
(focal-length (focal-length camera)) 
(x (first point-1n-camera-space)) ;x axis 1s along opical axis 
(y (second point-in-camera-space)) ;y is out right side of camera 
(z (third point-in-camera-space))) ;z 1s out bottom of camera 
(list (+ (round (* enlargement-factor (/ (* focal-length y) x))) 
150) ;to right in camera window 
(+ 150 (round (* enlargement-factor (/ (* focal-length (- z)) x))))) up in camera 
window 


a *** Position camera functions 3K 2K of RR RR RR RR oi ok oi ok ok ok 2 2k ok OK OK OK ok ok ok ok ' OK k sk 


(defmethod move-camera ((camera camera) azimuth elevation roll x y z) 
(setf (H-matrix camera) (homogeneous-transform azimuth elevation roll x y z)) 
(setf (inverse-H-matrix camera) (inverse-H (H-matrix camera)))) 


(defmethod zoom-camera ((camera camera) zoom-amount) 
(setf (slot-value camera 'enlargement-factor) 
(+ (slot-value camera “enlargement-factor) zoom-amount))) 


; Rotation in x-y plane about origin 
(defmethod rotate-camera ((camera camera) angle-increment) ; in degrees 
(let* ((new-position (posture camera)) 
(radius (sgrt (+ (* (fourth new-position) (fourth new-position)) 
(* (fifth new-position) (fifth new-position))))) 
(heading (atan (fourth new-position) 
(fifth new-position))) 
(angle (deg-to-rad angle-increment)) 
(new-heading (+ heading angle))) 
(setf (first new-position) (- (first new-position) angle) 
(fourth new-position) (* radius (sin new-heading)) 
(fifth new-position) (* radius (cos new-heading)) 
(posture camera) new-position 
(H-matrix camera) 
(homogeneous-transform (first new-position) 
(second new-position) (third new-position) (fourth new-position) 
(fifth new-position) (sixth new-position)) 
(inverse-H-matrix camera) (inverse-H (H-matrix camera))))) 
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; Vertical tilting about origin in a plane perpendicular to x-y plane 
; Max tilt (90 or -90 deg) when top or bottom view of x-y plane is achieved 
(defmethod tilt-camera ((camera camera) angle-increment) ; in degrees 
(let* ((new-position (posture camera)) 
(radius (sgrt (+ (* (fourth new-position) (fourth new-position)) 
(* (fifth new-position) (fifth new-position)) 
(* (sixth new-position) (sixth new-position))))) 
(tilt (atan (sixth new-position) 
(sqrt (+ (* (fourth new-position) (fourth new-position)) 
(* (fifth new-position) (fifth new-position)))))) 
heading (atan (fourth new-position) 
(fifth new-position))) 
(angle (deg-to-rad angle-increment)) 
(new-tilt (cond ((< (abs (+ tilt angle)) tilt-limit) (+ tilt angle)) 
(t (cond ((minusp (+ tilt angle)) (* -1 tilt-limit)) 
(t tilt-limit)))))) 
(setf (second new-position) new-tilt 
(fourth new-position) 
(cond ((= (abs tilt) (abs new-tilt) tilt-limit) 
(fourth new-position)) 
(t (* radius (sin heading) (cos new-tilt)))) 
(fifth new-position) 
(cond ((= (abs tilt) (abs new-tilt) tilt-limit) 
(fifth new-position)) 
(t (* radius (cos heading) (cos new-tilt)))) 
(sixth new-position) 
(cond ((= (abs tilt) (abs new-tilt) tilt-limit) 
(sixth new-position)) 
(t (* radius (sin new-tilt)))) 
(posture camera) new-position 
(H-matrix camera) 
(homogeneous-transform (first new-position) 
(second new-position) (third new-position) (fourth new-position) 
(fifth new-position) (sixth new-position)) 
(inverse-H-matrix camera) (inverse-H (H-matrix camera))))) 


(defun deg-to-rad (angle) (* .017453292519943295 angle)) 
(defconstant tilt-limit (deg-to-rad 89.9)) 
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(defun three-cameras () 

(setf caml (make-instance 'camera)) 

(setf (camera-window caml) (cw:make-window-stream 
:borders 5 
:left 900 
:bottom 0 
width 300 
:height 300 
:title "Dolphin Cam1" 
:activate-p t)) 


(setf cam2 (make-instance 'camera)) 
(setf (camera-window cam2) (cw:make-window-stream 
:borders 5 
:left 600 
:bottom O 
«width 300 
height 300 
:title “Dolphin Cam2” 
:activate-p t)) 
(setf cam3 (make-instance 'camera)) 
(setf (camera-window cam3) (cw:make-window-stream 
:borders 5 
:left 300 
“bottom 0 
«width 300 
:height 300 
:title "Dolphin Cam3" 
:activate-p t)) 
(move-camera cam] 0 (deg-to-rad -90) 0 0 0 -400) ; top view 
(move-camera cam2 00 0 -4000 0)  ;rear view 
(move-camera cam3 (deg-to-rad -90) 0 0 0 400 0)) ; side view 


(defmethod take-three () 
(take-picture cam] hunt1) 
(take-picture cam2 huntl) 
(take-picture cam3 hunt1)) 


(defmethod three-new-pictures () 


(clear-three) 
(take-three)) 
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(defmethod take-three-dolphins () 
(take-picture caml flip) 
(take-picture cam2 flip) 
(take-picture cam3 flip)) 


(defun clear-three () 
(cw:clear (camera-window caml)) 
(cw:clear (camera-window cam2)) 
(cw:clear (camera-window cam3))) 


(defun flush-three () 
(cw:flush (camera-window caml)) 
(cw:flush (camera-window cam2)) 
(cw:flush (camera-window cam3))) 


(defmethod zooml ((camera camera)) 
(move-camera camera (deg-to-rad -90) 0 0 0 20 0)) 


(defmethod zoom2 ((camera camera)) 
(move-camera camera (deg-to-rad -90) 0 0 0 15 0)) 


(defmethod zoom3 ((camera camera)) 
(move-camera camera (deg-to-rad -90) 00 0 10 0)) 


(defmethod zooml-three () 
(move-camera caml (deg-to-rad -90)000200) 
(move-camera cam2 0 0 0 -20 0 0) 
(move-camera cam3 0 (deg-to-rad -90) 0 0 0 -20)) 


(defmethod zoom2-three () 
(move-camera caml (deg-to-rad -90) 0 0 0 15 0) 
(move-camera cam2 000-1500) 
(move-camera cam3 0 (deg-to-rad -90) 000 -15)) 


(defmethod zoom3-three () 
(move-camera caml (deg-to-rad -90)000 10 0) 
(move-camera cam2 000-1000) 
(move-camera cam3 0 (deg-to-rad -90) 0 0 0 -10)) 
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(defmethod zoom-three () 
(move-camera caml 0 (deg-to-rad -90) 00 0 -200) 
(move-camera cam2 0 0 0 -200 0 0) 
(move-camera cam3 (deg-to-rad -90) 0 0 0 200 0)) 


; 2K 2K 2K Auxiliary functions 2K OK 2K OK 2K 2K 2K 2K 2K 2K 2K ok 2K OK N OK 2K K OK 2K OK 2K 2K 2K OK OK 2K OK 2K OK K K K K K K K K K K K K K K K OK K K K 


(defun kill () 
(cw:kill-common-windows)) 


(defun reset-windows () 


(kill) 


(cw:initialize-common-windows)) 
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€ mlolphin.cl ** 


(defclass dolphin () 
((body 
initform (make-instance 'dolphin-body) 
:accessor body) 
(right-fin 
:initform (make-instance 'right-fin 
:fin-attachment-angle (deg-to-rad 90)) 
:accessor right-fin) 
(left-fin 
initform (make-instance 'left-fin 
:fin-attachment-angle (deg-to-rad -90)) 
:accessor left-fin) 
(dorsal-fin 
anitform (make-instance 'dorsal-fin 
:fin-attachment-angle (deg-to-rad 90)) 
:accessor dorsal-fin) 
(tail-fin 
:initform (make-instance ‘tail-fin 
:fin-attachment-angle (deg-to-rad 0)) 
:accessor tail-fin) 
(node-list 
:initform '((0 00 1)) 
:accessor node-list))) 


85 


(defclass dolphin-body (rigid-body) 
((location 
anitform ‘(0 0 0)) 
(velocity 
initform ‘(0 0 0000) 
(velocity-growth-rate 
unitform (000000) 
(mass 
:Initform 400) 
(node-list 
:initform ; in centimeters 
(0001) 
(55 22 -22 1) (5522 22 1 SU 220250 222 20 povede 
(55 -22 -22 1) (55 -22 22 1) (-50 -22 22 1) (-50 -22 -22 1) ;ibody 
(55 -22 -22 1) (55 -22 22 1) (55 22 22 1) (55 22 -22 1) ;body 
(-50 -22 -22 1) (-50 -22 22 1) (-50 22 22 1) (-50 22 -22 1) ;body 
(55 22 22 1) (90 0 0 1) (55 22 -22 1) (90 0 0 1) nose 
(55 -22 22 1) (90 0 0 1) (55 -22 -22 1) (90 0 0 1) ;nose 
(-50 22 22 1) (-90 0 0 1) (-50 22 -22 1) (-90 0 0 1) ;end 
(-50 -22 22 1) (-900 0 1) (-50 -22 -22 1) (-90 00 1))) ;end 


(polygon-list 

initform '((1 23 4) (5 67 8) (9 10 11 12) (13 14 15 16) 
(17 18) 6 26) IT 22) DA PIPE) 
(27 28) (29 30) (31 32))) 

(H-matrix 

:initform (homogeneous-transform 00000 0)) 

(acceleration-profile 

initform '(((* (- 3) (cos t)) (* (- 3) (sin t)) 0 2))))) 


(defmethod initialize ((agua dolphin)) 

(initialize (body agua)) 

(initialize-fin (right-fin agua) agua) 

(initialize-fin (left-fin aqua) aqua) 

(initialize-fin (dorsal-fin aqua) aqua) 

(initialize-fin (tail-fin aqua) aqua) 

(setf (node-list aqua) (append (node-list (body aqua)) 
(node-list (link3 (right-fin agua))) 
(node-list (link3 (left-fin agua))) 
(node-list (link3 (dorsal-fin agua))) 
(node-list (link3 (tail-fin aqua)))))) 
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(defun aqua-picture () 
(setf flip (make-instance 'dolphin)) 
(initialize flip) 
(setf caml (make-instance 'camera)) 


(take-picture cami flip)) 


(defmethod take-picture ((camera camera) (agua dolphin)) 
(take-picture camera (body agua)) 
(take-picture camera (right-fin agua)) 
(take-picture camera (left-fin agua)) 
(take-picture camera (dorsal-fin agua)) 


(take-picture camera (tail-fin agua))) 


(defmethod move-and-flap-incremental ((agua dolphin) increment-list) 
(move-incremental (body aqua) (first increment-list)) 
(move-incremental (right-fin aqua) (second increment-list)) 
(move-incremental (left-fin aqua) (third increment-list)) 
(move-incremental (dorsal-fin aqua) (fourth increment-list)) 


(move-incremental (tail-fin aqua) (fifth increment-list))) 


(defmethod move-incremental ((aqua dolphin) increment-list) 
(move-incremental (body aqua) (first increment-list)) 
(move-incremental (right-fin agua) '(0)) 

(move-incremental (left-fin agua) '(0)) 
(move-incremental (dorsal-fin aqua) '(0)) 


(move-incremental (tail-fin aqua) *(0))) 
(defun new-dolphin () 


(setf flip (make-instance 'dolphin)) 
(1nitialize flip)) 
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: S Dn-linkl * 


(defclass linkO (rotary-link) 
((twist-angle :initform 0) 
(link-length :initform 0.0) 
(inboard-joint-angle :initform 0) 
(inboard-joint-displacement :initform 0) 
(min-joint-angle :initform (deg-to-rad -360)) 
(max-joint-angle :initform (deg-to-rad 360)) 
(node-list :initform “((0001)(0001)(20001))) 
(polygon-list :initform '((1 2))))) 


(defclass linkl (rotary-link) 
((twist-angle :initform 0.0) 
(link-length :initform 0.0) 
(inboard-joint-angle :initform 0) 
(inboard-joint-displacement :initform 0) 
(min-joint-angle :initform 0) 
(max-joint-angle :initform 0) 
(node-list 
initform *((000 1) 
(60 22.5 -60 1) (60 22.5 -75 1) (39 22.5 -75 1) 
(39 22.5 -60 1) ;right side 
(60 -22.5 -60 1) (60 -22.5 -75 1) (39 -22.5 -75 1) 
(39 -22.5 -60 1) ;left side 
(39 22.5 -60 1) (39 22.5 -75 1) (39 -22.5 -75 1) 
(39 -22.5 -60 1) ;back 
(60 22.5 -60 1) (60 22.5 -75 1) (60 -22.5 -75 1) 
(60 -22.5 -60 1))) ;front 
(polygon-list :initform ‘((1 23 4) (5 67 8) 9 10 11 12) 
(13 14 15 16))))) 


(defclass link2 (rotary-link) 
((twist-angle :initform (deg-to-rad 90)) 
(link-length :initform 0) 
(inboard-joint-angle :initform (deg-to-rad 0)) 
(inboard-joint-displacement :initform 0) 
(min-joint-angle :initform (deg-to-rad -90)) 
(max-joint-angle :initform (deg-to-rad 90)) 
(node-list :initform ‘((00 0 1) (000 1) (000 1))) 
(polygon-list :initform '((1 2))))) 
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(defclass link3 (rotary-link) 

((twist-angle :initform (deg-to-rad 0)) 
(link-length :initform 0) 

(inboard-joint-angle :initform (deg-to-rad 0)) 
(inboard-joint-displacement :initform 0) 
(min-joint-angle :initform (deg-to-rad -90)) 
(max-joint-angle :initform (deg-to-rad 90)) 
(node-list 

:initform ((000/1)(320/1)(-120 1) 1 50 1))) 
(polygon-list 

initform (((1 2 3))))) 


(defmethod update- A -matrix ((link link)) 
(with-slots (twist-angle link-length inboard-joint-angle 
inboard-joint-displacement A-matrix) link 
(setf A-matrix 
(dh-matrix 
(cos inboard-joint-angle) 
(sin inboard-joint-angle) (cos twist-angle) 
(sin twist-angle) 
link-length inboard-joint-displacement)))) 


(defmethod rotate ((link rotary-link) angle) 
(setf (Inboard-joint-angle link) angle) 
(update-A-matrix link) 
(setf (H-matrix link) (matrix-multiply (H-matrix (inboard-link link)) 
(A-matrix link))) 
(transform-node-list link)) 


(defmethod rotate-link ((link rotary-link) angle) 
(cond ((> angle (max-joint-angle link)) 
(rotate link (max-joint-angle link)) 
(setf (motion-limit-flag link) t)) 
((< angle (min-joint-angle link)) 
(rotate link (min-joint-angle link)) 
(setf (motion-limit-flag link) t)) 
(t (rotate link angle) (setf (motion-limit-flag link) nil)))) 
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;** finc] ** 


(defclass dolphin-fin () 
((fin-attachment-angle 
unitarg :fin-attachment-angle 
:accessor fin-attachment-angle) 
link2 
:initform (make-instance ‘link2) 
:accessor link2) 
(link3 
anitform (make-instance “link3) 
:accessor link3) 
(motion-complete-flag 
anitform nil 
:accessor motion-complete-flag) 
(previous-fin-position 
anitform nil 
:accessor previous-fin-position) 
(current-fin-position 
initform nil 
:accessor current-fin-position))) 


(defclass right-fin (dolphin-fin) 

((link2 :initform (make-instance “link2 
:link-length 22 
:twist-angle (deg-to-rad 90) 
:lnboard-joint-displacement 1)) 

(link3 :initform (make-instance “link3 
:node-list '((0001)(010101) 

(44 30 0 1) (00 40 1)))))) 


(defclass left-fin (dolphin-fin) 

((link2 :initform (make-instance "link? 
:link-length 22 
:twist-angle (deg-to-rad 90) 
:Inboard-joint-displacement 1)) 

(link3 :initform (make-instance “link3 
:node-list ‘((0 0 0 1) (0 10 -10 1) 

(44 30 0 1) (0 0 -40 1))))) 


90 


(defclass dorsal-fin (dolphin-fin) 
((link2 :initform (make-instance “link2 
:link-length O 
:twist-angle (deg-to-rad 90))) 
(link3 :initform (make-instance “link3 
:node-list *((000 1) (0 -22 -10 1) 
(0 -55 -20 1) (0 -22 17 1)))))) 


(defclass tail-fin (dolphin-fin) 

((link2 :initform (make-instance “link2 
:link-length -90 
:twist-angle (deg-to-rad 90) 
:node-list *((0 0 0 1) (00 0 1))) 

(link3 :initform (make-instance 'link3 
:node-list *((0 0 0 1) (-22 0 22 1) 

(-22 0 -22 1) (000 1)) 

:polygon-list *((1 2 3))))) 


(defmethod initialize-fin ((fin dolphin-fin) (aqua dolphin)) 
(setf (inboard-link (link2 fin)) (body aqua)) 
(setf (inboard-link (link3 fin)) (link2 fin)) 
(rotate-link (link2 fin) (fin-attachment-angle fin)) 
(rotate-link (link3 fin) (inboard-joint-angle (link3 fin))) 
(setf (current-fin-position fin) 
(firstn 3 (first (transform-node-list (link3 fin)))))) 


(defmethod take-picture ((camera camera) (fin dolphin-fin)) 
(take-picture camera (link3 fin))) 


(defmethod move-incremental ((fin dolphin-fin) increment-list) 
(rotate-link (link2 fin) (fin-attachment-angle fin)) 
(rotate-link (link3 fin) 
(*- (first increment-list) (inboard-joint-angle 
(link3 fin)))) 

(setf (previous-fin-position fin) (current-fin-position fin)) 
(setf (current-fin-position fin) 
(firstn 3 (first (transformed-node-list (link3 fin))))) 
| (setf (motion-complete-flag fin) (not (or (motion-limit-flag 

(link3 fin)))))) 


: ** hunter.c] ** 


(defclass hunter () 

((dolphin 
:initform (make-instance *dolphin) 
:accessor dolphin) 

(sans 
:Initform (make-instance 'sans) 
‘accessor sans) 

(node-list 
:Initform '((0 00 1)) 
:accessor node-list))) 


(defmethod initialize ((huntl hunter)) 
(setf delta-t (get-delta-t (Sans huntl))) 
(initialize (dolphin huntl)) 
(initialize-sans (sans huntl) huntl) 
(setf (node-list hunt1) (append (node-list (dolphin huntl)) 
(node-list (link1 (sans hunt1))))) 
(update-velocity-growth-rate hunt1) 
(transform-node-list hunti)) 


(defmethod make-hunter-picture () 
(setf hunt] (make-instance "hunter)) 
(initialize huntl) 

(x-picture) 
(setf caml (make-instance 'camera)) 
(take-picture caml huntl)) 


(defun create-hunter-1 () 
(setf huntl (make-instance 'hunter)) 
(initialize huntl)) 


(defmethod take-picture ((camera camera) (huntl hunter)) 
(take-picture camera (dolphin huntl)) 
(take-picture camera (link1 (sans hunt1)))) 


(defun hunter-picture () 
(create-hunter-1) 
(create-camera-1) 
(take-picture camera-1 hunt1)) 


92 


(defmethod move-incremental ((huntl hunter) increment-list) 
(move-incremental (dolphin huntl) increment-list) 
(move-incremental (sans huntl) (first increment-list))) 


(defmethod move-and-flap-incremental ((huntl hunter) increment-list) 
(move-and-flap-incremental (dolphin hunt1) increment-list) 
(move-incremental (sans huntl) (first increment-list))) 


(defmethod update-posture ((huntl hunter) delta-t) 
(setf increment-list (list 

(list 
(* delta-t (sixth (velocity (sans hunt1)))) 
(* delta-t (fifth (velocity (sans hunt1)))) 
(* delta-t (fourth (velocity (sans hunt1)))) 
(* delta-t (first (velocity (sans hunt1)))) 
(* delta-t (second (velocity (sans hunt1)))) 
(* delta-t (third (velocity (sans hunt1))))))) 

(move-incremental huntl increment-list)) 


(defmethod update-posture-2 ((huntl hunter)) 
(setf increment-list (list 
(list 0 0 0 
(delta-range (sans hunt1)) 
0 


(delta-depth (sans hunt1))))) 
(move-incremental huntl increment-list)) 


(defmethod x-picture () 
(setf x (make-instance 'rigid-body 
:node-list *((0 0 0 1) (50 0 50 1) (-50 0 -50 1) 


(50 0 -50 1) (-50 0 50 1)))) 
(initialize x)) 


(defun hunter-video () 
(create-hunter-1) 
(create-video-camera-1) 
(take-picture camera-1 huntl)) 


(defun hunter-movie () 
(create-hunter-1) 
(create-movie-camera-1) 
(take-picture camera-1 hunt1)) 
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(defun hunter-3-movies () 
(create-hunter-1) 
(create-3-movie-cameras) 
(take-three)) 


(defmethod new-hunter () 
(setf huntl (make-instance 'hunter)) 
(initialize hunt1)) 


(defmethod new-picture ((camera camera) (huntl hunter)) 
(erase-camera-window camera) 
(take-picture camera huntl)) 


(defmethod display-acceleration-profile ((huntl hunter) 
(camera camera) acceleration-profile) 
(dolist (element acceleration-profile) 
(read-acceleration-profile (sans huntl) element) 
(setf (location (body (dolphin huntl))) (location (sans huntl))) 
(setf (velocity (body (dolphin hunt1))) (velocity (sans huntl))) 
(setf (velocity-growth-rate (body (dolphin hunt1))) 
(velocity-growth-rate (sans huntl))) 
(update-posture hunt] delta-t) 
(take-picture camera hunt1))) 


(defmethod read-acceleration-profile ((body rigid-body) element) 

(setf (first (velocity-growth-rate body)) 

(* 100 (first element))) longitudinal 
(setf (turn-radius (sans hunt1)) (* 100 (second element))) 
(setf delta-t (- (fourth element) (third element))) 
(calculate-velocity-and-normal body delta-t) 
(setf (climb-angle (sans huntl)) 

(rad-to-deg (atan (/ (third (velocity-growth-rate body)) 

(first (velocity-growth-rate body)))))) 

(update-velocity body delta-t) 
(update-location (sans huntl) delta-t) 
(update-delta-range (sans huntl)) 
(set-accelerometer huntl)) 
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(defmethod calculate-velocity-and-normal ((body rigid-body) delta-t) 
(setf delta-v (* (first (velocity-growth-rate body)) delta-t)) 
(setf new-velocity (+ delta-v (first (velocity body)))) 
(setf (third (velocity-growth-rate body)) 
(/ (* new-velocity new-velocity) (turn-radius (sans hunt1))))) 


(defmethod set-accelerometer ((huntl hunter)) 

(setf (sensed-acceleration (sans huntl)) 

(+ (first (velocity-growth-rate (sans huntl ))) 

(* *gravity* (sin (deg-to-rad (climb-angle (sans hunt1))))))) 

(setf apparent-climb-angle 

(rad-to-deg (asin (+ (sin (deg-to-rad (climb-angle (sans huntl )))) 

(/ (first (velocity-growth-rate 
(sans hunt1))) *gravity*))))) 

(update-horizontal-error hunt1)) 


(defmethod update-horizontal-error ((huntl hunter)) 
(setf (horizontal-error (sans huntl)) 
(* (delta-depth (sans hunt1)) 
(- (/ 1 (tan (deg-to-rad (climb-angle (sans hunt1))))) 
(/ 1 (tan (deg-to-rad apparent-climb-angle))))))) 


(defmethod display-acceleration-profile-2 ((huntl hunter) 


(camera camera) acceleration-profile) (dolist (element acceler- 
ation-profile) 


(read-acceleration-profile-2 (sans huntl) element) 
(setf (location (body (dolphin hunt1))) (location (sans huntl))) 
(setf (velocity (body (dolphin hunt1))) (velocity (sans hunt1))) 
(setf (velocity-growth-rate (body (dolphin hunt1))) 
(velocity-growth-rate (sans huntl))) 
(update-posture-2 huntl) 
(take-picture camera huntl) 
(move-horizontal x (+ (horizontal-error (sans hunt1)) 
(first (location (sans hunt] )))) 

(second (location (sans huntl))) 

(third (location (sans huntl)))) 
(take-picture camera x))) 


95 


(defmethod read-acceleration-profile-2 ((body rigid-body) element) 
(setf (first (velocity-growth-rate body)) 
(* 100 (first element))) longitudinal 
(setf (turn-radius (sans hunt1)) (* 100 (second element))) 
(setf delta-t (- (fourth element) (third element))) 
(calculate-velocity-and-normal-2 body delta-t) 
(update-delta-range (sans huntl)) 
(update-velocity body delta-t) 
(update-location-2 (sans huntl) delta-t) 
(set-accelerometer hunt1)) 


(defmethod calculate-velocity-and-normal-2 ((bòdy rigid-body) delta-t) 
(setf delta-v (" (first (velocity-growth-rate body)) delta-t)) 
(setf new-velocity (+ delta-v (first (velocity body)))) 
(setf (third (velocity-growth-rate body)) 
(* (Arst (velocity-growth-rate body)) 
(tan (deg-to-rad (climb-angle (sans hunt1))))))) 


(defmethod update-velocity-grovvth-rate ((huntl hunter)) 
(update-velocity-growth-rate (body (dolphin hunt1))) 
(update-velocity-growth-rate (sans huntl))) 


(defmethod transform-node-list ((huntl hunter)) 
(transform-node-list (sans huntl)) 
(transform-node-list (body (dolphin hunt1)))) 


(defmethod run-profile ((hunt1 hunter)) 
(display-acceleration-profile huntl caml profile) 
(move-horizontal x (+ (horizontal-error (sans huntl)) 

(first (location (sans huntl )))) 
(second (location (sans huntl))) 
(third (location (sans huntl)))) 
(take-picture caml x)) 


(defun h-error () 
(/ (horizontal-error (sans huntl)) 100)) 
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(defun camera-setup () 
(setf display (make-instance 'camera)) 
(setf (camera-window display) (cw:make-window-stream 
:borders 5 
:left 800 
:bottom 800 
:width 1400 
:height 600 
:title “Dolphin in Motion” 
:activate-p t)) 
(move-camera display (deg-to-rad -90) 0 0 2800 6000 -2800) ; side view 
(zoom-camera display 20)) 
; (move-camera display 0 0 0 -40000 0 0) ; rear view 
; (move-camera display 0 (deg-to-rad -90) 0 0 0 -40000) ; top view 


; Calculates the error from a given climb angle 
(defun calculate-error (climb-angle profile display) 
(load “hunter.cl”) 
(setf huntl (make-instance 'hunter)) 
(initialize hunt1) 
(setf (location (sans hunt1)) ‘(0 0 0)) 
; (three-cameras) 
; (take-three) 
(x-picture) 
(take-picture display huntl) 
(setf (climb-angle (sans hunt1)) climb-angle) 
(setf total-distance '0) 
(display-acceleration-profile-2 huntl display profile) 
(move-horizontal x (4 (horizontal-error (sans huntl)) 
(first (location (sans huntl)))) 
(second (location (sans huntl))) 
(third (location (sans huntl)))) 
(take-picture display huntl) 
(take-picture display x) 
(h-error)) 


(defmethod calculate-error-demo (climb-angle profile) 


(Camera-setup) 
(calculate-error (climb-angle profile display))) 
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, Calculates the error by determining climb angle from the given turn radius 
(defmethod error-given-turn-radius () 
(setf huntl (make-instance 'hunter)) 
(initialize huntl) 
; (three-cameras) 
; (take-three) 
(setf display (make-instance 'camera)) 
(setf (camera-window display) (cw:make-window-stream 
:borders 5 
left 600 
:bottom 600 
«width 600 
:height 600 
title “Dolphin in Motion” 
:activate-p t)) 
(move-camera display (deg-to-rad -90) 0 0 0 10000 0) ; side view 
; (move-camera display 0 0 0 -40000 0 0) ; rear vlew 
; (move-camera display 0 (deg-to-rad -90) 0 0 0 -40000) ; top view 
(x-picture) 
(take-picture display huntl) 
(display-acceleration-profile huntl display profile) 
(move-horizontal x (+ (horizontal-error (sans huntl)) 
(first (location (sans hunt1)))) 
(second (location (sans hunt1))) 
(third (location (sans huntl)))) 
(take-picture display huntl) 
(take-picture display x)) 
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>  #link.ci ** 


(defclass link (rigid-body) 

((motion-limit-fiag 

:initform nil 

:accessor motion-limit-flag) 
(twist-angle 

:Initarg :twist-angle 

:accessor tvvist-angle) 
(link-length 

initarg :link-length 

:accessor link-length) 
(inboard-joint-angle 

:Initarg :inboard-joint-angle 

:accessor inboard-joint-angle) 
(inboard-joint-displacement 

:Initarg :inboard-joint-displacement 

:accessor inboard-joint-displacement) 
(inboard-link 

:Initarg :inboard-link 

:accessor inboard-link) 

(A -matrix 

:accessor A-matrix))) 


(defclass rotary-link (link) 
((min-joint-angle 
:initarg :min-joint-angle 
:accessor min-joint-angle) 
(max-joint-angle 
anitarg :max-Joint-angle 
:accessor max-joint-angle))) 


(defclass sliding-link (link) 
((min-joint-displacement 
:Initarg :min-joint-displacement 
:accessor min-joint-displacement) 
(max-joint-displacement 
:initarg :max-joint-displacement 
:accessor max-joint-displacement))) 
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: ** loadgales-3.ch ++ 
(defun load-hunter () 


: Abstract class files 
(load "rigid-body.cl") 
(load “link.cl”) 


; Specific Graphics and Display files 
(load “camera.cl”) 


; Specific Hunter files 
(load “profiles.cl”) 
(load “robot-kinematics.cl’’) 
(load “dolphin.cl’’) 
(load “hunter.cl”) 
(load “sans.cl”) 
(load “‘fin.cl’’) 
(load “‘fin-link.cl’’)) 


(defun compile-hunter () 
; Specific Graphics and Display files 
(compile-file *camera.cl")  ; must be first to avoid name conflicts 
; may complain it can't finddeg-to-rad() 
; Abstract class files 
(compile-file "rigid-body.cl") 
(compile-file “link.cl’’) 


; Specific Hunter files 
(compile-file “profiles.cl”) 
(compile-file “robot-kinematics.cl”) 
(compile-file “dolphin.cl”) 
(compile-file “hunter.cl”) 
(compile-file "sans.cl") 
(compile-file "fin.cl") 
(compile-file “fin-link.cl’’)) 


(defun load-compiled-hunter () 


; Specific Graphics and Display files 
(load “camera.fasl”) ; needs to be first to avoid name conflicts error 


100 


; Abstract class files 
(load “rigid-body.fasl”) 
(load “link.fasl”) 


; Specific Hunter files 
(load “profiles.fasl”) 
(load “robot-kinematics.fasl”) 
(load “dolphin.fasl”) 
(load “hunter.fasl”) 
(load “sans.fasl”) 
(load “fin.fasl”) 
(load “fin-link.fasl”)) 
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z load lese s 
(defun load-hunter () 


: Abstract class files 
(load “rigid-body.cl”) 
(load “link.cl”) 


; Specific Graphics and Display files 
(load “camera.cl”) 
; Specific Hunter files 
(load "profiles.cl") 
(load “robot-kinematics.cl””) 
(load “dolphin.cl’’) 
(load “hunter.cl’’) 
(load “‘sans.cl’’) 
(load “‘fin.cl’’) 
(load “‘fin-link.cl’’)) 


(defun compile-hunter () 
; Specific Graphics and Display files 
(compile-file "camera.cl") ; must be first to avoid name conflicts 
; may complain it can't finddeg-to-rad() 
; Abstract class files 
(compile-file "rigid-body.cl") 
(compile-file “link.cl’’) 


; Specific Hunter files 
(compile-file "profiles.cl") 
(compile-file "robot-Rinematics.cl") 
(compile-file “dolphin.cl’’) 
(compile-file “hunter.cl”) 
(compile-file “sans.cl”) 
(compile-file “‘fin.cl’’) 
(compile-file “fin-link.cl”)) 


(defun load-compiled-hunter () 


; Specific Graphics and Display files 
(load “camera.fasl”) ; needs to be first to avoid name conflicts error 
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: Abstract class files 
(load "rigid-body.fasl") 
load "link.fasl") 


; Specific Hunter files 
(load "profiles.fasl") 
(load “robot-kinematics.fasl”) 
(load “dolphin.fasl”) 
(load “hunter.fasl”) 
(load “sans.fasl”) 
(load “fin.fasl”) 
(load “fin-link.fasl”)) 
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; ** newsetupicl ** 


(load "load-files.cl") 
(load-hunter) 
(compile-hunter) 
(load-compiled-hunter) 


fo setup mel 

(load “‘load-files-3.cl’’) 
(load-hunter) 
(compile-hunter) 
(load-compiled-hunter) 
e setup ci” 


(load “load-files.cl”) 
(load-compiled-hunter) 








;** rigid-body.cl ** 


(defclass rigid-body 

O 

(location ; The three-vector (x y z) in world coordinates. 
initform ‘(0 0 0) 
unitarg :location 
:accessor location) 

(velocity ¡The six-vector (u v w p q r) in body coordinates. 
anitform (11 1.1.1.1) 
:Initarg :velocity 
:accessor velocity) 

(velocity-growth-rate ;The vector (u-dot v-dot w-dot p-dot g-dot r-dot). 
anitform *(0 0 0 0 0 0) 
:accessor velocity-growth-rate) 

(forces-and-torgues ;The vector (Fx Fy Fz L M N) in body coordinates. 
:Initform (000000) 
:Initarg :forces-and-torques 
:accessor forces-and-torgues) 

(moments-of-inertia ;The vector (Ix Iy Iz) in principal axis coordinates. 
:initform '(1 1 1) 
:initarg :moments-of-inertla 
:accessor moments-of-ınertla) 

(mass 
anitform 1 
:Initarg :mass 
‘accessor mass) 

(node-list ;(x y z 1) in body coord for each node. Starts with (0 0 0 1). 
anitform *((0 0 0 1)) 
anitarg :node-list ; x 
:accessor node-list) 

(polygon-list 
unitform '((1 2) (3 4) 
:Initarg :polygon-list 
:accessor polygon-list) 

(transformed-node-list ;(x y z 1) in earth coord for each node in node-list 
:accessor transformed-node-list) 

(H-matrix 
:Initform (unit-matrix 4) 
:accessor H-matrix) 

(current-time 
:initform 1979487650 
:accessor current-time) 
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(delta-depth 

initform 0 

:accessor delta-depth) 
(delta-range 

:Initform 0 

:accessor delta-range) 
(depth 

:Initform O 

:accessor depth) 
(range 

anitform O 

:accessor range))) 


(defmethod initialize ((body rigid-body)) 
(update-velocity-growth-rate body) 
(transform-node-list body)) 


(defmethod move-horizontal ((body rigid-body) x y z) 
(setf (H-matrix body) 
(homogeneous-transform 0 0 0 x y z)) 
(transform-node-list body) 


(setf (location body) (firstn 3 (first (transformed-node-list body))))) 


(defmethod move-body ((body rigid-body) azimuth elevation roll x y z) 
(setf (H-matrix body) 


(homogeneous-transform azimuth elevation roll x y z)) 
(transform-node-list body) 
(update-position body)) 


(defmethod move-incremental ((body rigid-body) increment-list) 
(setf (H-matrix body) 


(matrix-multiply (H-matrix body) 
(homogeneous-transform 
(first increment-list) ; body z rotation 
(second increment-list) ;body y rotation 
(third increment-list) ;body x rotation 
(fourth increment-list) ;body x translation 
(fifth increment-list) ;body y translation 


(sixth increment-list)))) ;body z translation 
(transform-node-list body) 


(update-position body)) 


106 


(defmethod get-delta-t ((body rigid-body)) 
(let* ((new-time (get-internal-real-time)) 
(delta-t (/ (- new-time (current-time body)) 1000000))) 
(setf (current-time body) new-time) 
delta-t)) 


(defmethod start-timer ((body rigid-body)) 
(setf (current-time body) (get-internal-real-time))) 


(defmethod update-velocity-growth-rate ((body rigid-body)) 
(setf (velocity-growth-rate body)  ;Assumes principal axis coordinates with (multiple- 


value-bind origin at center of gravity of body. 
(Fx Fy FZL MN uvwpgr Ix ly Iz) ;Declares local variables. 
(values-list ; Values assigned. 
(append 


(forces-and-torques body) (velocity body) (moments-of-inertia body))) 
(list (+ (* v r) (* -1 w q) (/ Fx (mass body)) 
(* *gravity* (first (third (H-matrix body))))) 
(+ (* w p) (* -1 u r) (/ Fy (mass body)) 
(* *eravity* (second (third (H-matrix body))))) 
(+ (* u q) (* -1 v p) (/ Fz (mass body)) 
(* *eravity* (third (third (H-matrix body))))) 
(/ (+ (* (- Iy Iz) q r) L) Ix) 
(/ (+ (* (- Iz Ix) r p) M) Iy) 
(/ (- (* C Ix Iy) p q) N) Iz2)))) ; Value returned. 


(defmethod update-velocity ((body rigid-body) delta-t)(defmethod update-posture ((body 
rigid-body) delta-t) ;Euler integration. 
(move-incremental body 
(list (* delta-t (sixth (velocity body))) 
(* delta-t (fifth (velocity body))) 
(* delta-t (fourth (velocity body))) 
(* delta-t (first (velocity body))) 
(* delta-t (second (velocity body))) 
(* delta-t (third (velocity body)))))) 


(defmethod update-location ((body rigid-body) delta-t) 
(setf (location body) 
(vector-add (location body) 
(scalar-multiply delta-t (velocity body))))) 
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(defmethod update-location-2 ((body rigid-body) delta-t) 
(setf (first (location body)) (range body)) 
(setf (third (location body)) (depth body))) 


(defmethod transform-node-list ((body rigid-body)) 
(setf (transformed-node-list body) 
(mapcar #’ (lambda (node-location) 
(post-multiply (H-matrix body) node-location)) 
(node-list body)))) 


(defmethod update-position ((body rigid-body)) 
(setf (location body) (firstn 3 (first (transformed-node-list body))))) 


(defmethod update-delta-range ((body rigid-body)) 
(setf delta-distance (+ (* (first (velocity-growth-rate body)) delta-t delta-t .5) 
(* (first (velocity body)) delta-t))) 

(setf total-distance (+ total-distance delta-distance)) 
(setf (depth body) 

(* (sin (deg-to-rad (climb-angle body))) total-distance)) 
(setf (delta-depth body) 

(* (sin (deg-to-rad (climb-angle body))) delta-distance)) 
(setf (range body) 

(* (cos (deg-to-rad (climb-angle body))) total-distance)) 
(setf (delta-range body) 

(* (cos (deg-to-rad (climb-angle body))) delta-distance))) 


(defconstant *gravity* 981) — ;cm/sec 
(defun deg-to-rad (angle) (* .017453292519943295 angle)) 
(defun rad-to-deg (radian) (/ radian .017453292519943295)) 
(defun feet-to-cm (feet) (* 30.48 feet)) 
(defun cm-to-feet (cm) (/ cm 30.48)) 

(setf (velocity body) 


(vector-add (velocity body) 
(scalar-multiply delta-t (velocity-growth-rate body))))) 
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» ** robot-kinematics.cl ** 


(defun transpose (matrix) ¿A matrix is a list of row vectors. 
(cond ((null (cdr matrix)) (mapcar “list (car matrix))) 
(t (mapcar 'cons (car matrix) (transpose (cdr matrix)))))) 


(defun dot-product (vector-1 vector-2) ;A vector is a list of numerical atoms 
(apply “+ (mapcar ** vector-1 vector-2))) 


(defun vector-magnitude (vector) (sqrt (dot-product vector vector))) 


(defun post-multiply (matrix vector) 
(cond ((null (rest matrix)) (list (dot-product (first matrix) vector))) 
(t (cons (dot-product (first matrix) vector) 
(post-multiply (rest matrix) vector))))) 


(defun pre-multiply (vector matrix) 
(post-multiply (transpose matrix) vector)) 


(defun matrix-multiply (A B) :A and B are conformable matrices. 
(cond ((null (cdr A)) (list (pre-multply (car A) B))) 
(t (cons (pre-multiply (car A) B) (matrix-multiply (cdr A) B))))) 


"Lis a list of names of conformable matrices. 
(defun chain-multiply (L) 

(cond ((null (cddr L)) (matrix-multiply (eval (car L)) (eval (cadr L)))) 

(t (matrix-multiply (eval (car L)) (chain-multiply (cdr L)))))) 

(defun cycle-left (matrix) (mapcar 'row-cycle-left matrix)) 
(defun row-cycle-left (row) (append (cdr row) (list (car row)))) 
(defun cycle-up (matrix) (append (cdr matrix) (list (car matrix)))) 
(defun unit-vector (one-column length) ;Column count starts at 1. 

(do ((n length (1- n)) 


(vector nil (cons (cond ((= one-column n) 1) (t 0)) vector))) 
((zerop n) vector))) 
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(defun unit-matrix (size) 
(do ((row-number size (1- row-number)) 
(I nil (cons (unit-vector row-number size) 1))) 
((zerop row-number) I))) 


; A and B are matrices with equal number of rows. 
(defun concat-matrix (A B) 
(cond ((null A) B) 
(t (cons (append (car A) (car B)) (concat-matrix (cdr A) (cdr B)))))) 


(defun augment (matrix) 
(concat-matrix matrix (unit-matrix (length matrix)))) 


(defun normalize-row (row) (scalar-multiply (/ 1.0 (car row)) row)) 


(defun scalar-multiply (scalar vector) 
(cond ((null vector) nil) 
(t (cons (* scalar (car vector)) 
(scalar-multiply scalar (cdr vector)))))) 


,Reduces first column to (10 ... 0). 
(defun solve-first-column (matrix) 
(dot ((remaining-rovv-list matrix (rest remaining-row-list)) 
(first-row (normalize-row (first matrix))) 
(answer (list first-row) 
(cons (vector-add 
(first remaining-row-list) 
(scalar-multiply 
(- (caar remaining-row-list)) first-row)) answer))) 
((null (rest remaining-row-list)) (reverse answer)))) 


(defun vector-add (vector-1 vector-2) (mapcar *+ vector-1 vector-2)) 
(defun vector-subtract (vector-1 vector-2) (mapcar *- vector-1 vector-2)) 


;Returns leftmost square matrix from argument. 
(defun first-square (matrix) 
(do ((size (length matrix)) 
(remainder matrix (rest remainder)) 
(answer nil (cons (firstn size (first remainder)) answer))) 
((null remainder) (reverse answer)))) 


110 


(defun firstn (n list) 
(cond ((zerop n) nil) 
(t (cons (first list) (firstn (1- n) (rest list)))))) 


(defun max-car-firstn (n list) 
(append (max-car-first (firstn n list)) (nthcdr n list))) 


(defun matrix-inverse (M) 
(do ((M1 (max-car-first (augment M)) 
(cond ((null M1) nil) 
(t (max-car-firstn n (cycle-left (cycle-up M1)))))) 
(n (1- (length M)) (1- n))) 
((or (minusp n) (null M1)) (cond ((null M1) nil) (t (first-square M1)))) 
(setq M1 (cond ((zerop (caar M1)) nil) (t (Solve-first-column M1)))))) 


‘Lis a list of lists. This function finds list with 
«largest car and moves it to head of list of lists. 
(defun max-car-first (L) 
(cond ((null (cdr L)) L) 
(t (if (> (abs (caar L)) (abs (caar (max-car-first (cdr L))))) L 
(append (max-car-first (cdr L)) (list (car L))))))) 


(defun dh-matrix (cosrotate sinrotate costwist sintwist length translate) 
(list (list cosrotate (- (* costwist sinrotate)) 
(* sintwist sinrotate) (* length cosrotate)) 
(list sinrotate (* costwist cosrotate) 
(- (* sintwist cosrotate)) (* length sinrotate)) 
(list O. sintwist costwist translate) (list 0. 0. 0. 1.))) 


(defun homogeneous-transform (azimuth elevation roll x y z) 
(rotation-and-translation (sin azimuth) (cos azimuth) (sin elevation) 
(cos elevation) (sin roll) (cos roll) x y z)) 


(defun rotation-and-translation (spsi cpsi sth cth sphi cphi x y z) 
(list (list (* cpsi cth) (- (* cpsi sth sphi) (* spsi cphi)) 
(+ (* cpsi sth cphi) (* spsi sphi)) x) 
(list (* spsi cth) (+ (* cpsi cphi) (* spsi sth sphi) 
(- (* spsi sth cphi) (* cpsi sphi)) y) 
(list (- sth) (* cth sphi) (* cth cphi) z) 
(list 0. 0.0. 1.))) 
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;H is a 4x4 homogeneous transformation matrix. 
(defun inverse-H (H) 
det" ((minus-P (list (- (fourth (first H))) 
(- (fourth (second H))) 
(- (fourth (third H))))) 
(inverse-R (transpose (first-square (reverse (rest (reverse H)))))) 
(inverse-P (post-multiply inverse-R minus-P))) 
(append (concat-matrix inverse-R (transpose (list inverse-P))) 
(list (list 0 0 0 1)))) 


(setf x ((1 2) (3 4))) 
) 
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© K ams.cl "S 


(defclass sans (rigid-body) 


(location 

anitform '(00 0)  ;xy z (rigid body dolphin in a plane) 
(velocity 

initform (000000) 


(velocity-growth-rate 

:Inttform (000000)  ;tangential and normal 
(forces-and-torques 

anitform “(0 0 000 0)) 
(moments-of-inertia 

unitform (1 1 1)) 

(mass 

anitform 5) 

(H-matrix 

:initform (homogeneous-transform 00000 0)) 
(sensed-acceleration 

unitform ‘(0 0 0) 

:initarg :sensed-acceleration 
:accessor sensed-acceleration) 
(turn-radius 

unitform 0 

:initarg :turn-radius 

:accessor turn-radius) 
(climb-angle 

anitform O 

:accessor climb-angle) 
(delta-depth 

:initform O 

:accessor delta-depth) 
(horizontal-error 

:initform O 

:accessor horizontal-error) 
(fin-attachment-angle 

:Initarg :fin-attachment-angle 
:Initform 0 

:accessor fin-attachment-angle) 
(linkO 

:Initform (make-instance ‘linkO) 
:accessor linkO) 

(link1 

:lnitform (make-instance 'linkl  ;in centimeters 
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:node-list '((0 00 1) 
(25 10 -22 1) (37 10 -22 1) 
(37 10 -30 1) (25 10 -30 1) ;right side 
(25 -10 -22 1) (37 -10 -22 1) 
(37 -10 -30 1) (25 -10 -30 1) ;left side 
(37 10 -22 1) (37 -10 -22 1) 
(37 -10 -30 1) (37 10 -30 1) :front 
(25 10 -22 1) (25 -10 -22 1) 
(25 -10 -30 1) (25 10 -30 1) ;back 


(25 3 -30 1) (25 -3 -30 1) 

(25 -3 -33 1) (25 3 -33 1) ; back of antenna 
(31 3 -30 1) (31 -3 -30 1) 

(31 -3 -33 1) (31 3 -33 1), front of antenna 
(25 3 -30 1) (31 3 -30 1) 

(31 3 -33 1) (25 3 -33 1); right side 

(25 -3 -30 1) (31 -3 -30 1) 

(31 -3 -33 1) (25 -3 -33 1) : left side 


(25 2 -33 1) (31 2 -33 1) (28 O -44 1) 

(31 2 -33 1) (31 -2 -33 1) (28 0 -44 1) 

(31 -2 -33 1) (25 -2 -33 1) (28 O -44 1) 

(25 -2 -33 1) (25 2 -33 1) (28 O -44 1)) ; top of antenna 


:polygon-list '((1 2 3 4) (5 67 8) (9 10 11 12) 
(13 14 15 16) (17 18 19 20) 
(21 222324) (25 26 2723) 
(29 30 31 32) (33 34 35) (36 37 38) 
(39 40 41) (42 43 44)) 


:min-joint-angle '0 
:max-joint-angle *0) 
:accessor link]) 
(motion-complete-flag 
anitform nil 
:accessor motion-complete-flag) 
(previous-fin-position 
initform nil 
:accessor previous-fin-position) 
(current-fin-position 
anitform nil 
:accessor current-fin-position))) 
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(defmethod initialize-sans ((sans sans) (huntl hunter)) 
(setf (inboard-link (linkO sans)) (body (dolphin hunt1))) 
(setf (inboard-link (linkl sans)) (linkO sans)) 
(rotate-link (link0 sans) (fin-attachment-angle sans)) 
(rotate-link (link 1 sans) (inboard-joint-angle (link 1 sans))) 
(setf (current-fin-position sans) 

(firstn 3 (first (transformed-node-list (link1 sans))))) 

(update-velocity-growth-rate sans) 
(transform-node-list (link1 sans))) 


(defmethod move-incremental ((sans sans) increment-list) 
(rotate-link (link0 sans) (fin-attachment-angle sans)) 
(rotate-link (link1 sans) 
(+ (first increment-list) (inboard-joint-angle (linkl sans)))) 
(setf (previous-fin-position sans) (current-fin-position sans)) 
(setf (current-fin-position sans) 
(firstn 3 (first (transformed-node-list (linkl sans))))) 
(setf (motion-complete-flag sans) (not (or (motion-limit-flag (linkO sans)) 
(motion-limit-flag (link1 sans)))))) 
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APPENDIX C: PLOTS OF STATIC-TEST DATA 
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Figure 31. Motorola First Acguisition Time After Ninety Seconds Off 
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Figure 32. Motorola First Acquisition Accuracy After Ninety Seconds Off 
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Mean = 22°03 sec 
Standard Deviation = 2.64 sec 
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Figure 33. Motorola First Acquisition Time After Ten Minutes Off 
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Figure 34. Motorola First Acquisition Accuracy After Ten Minutes Off 
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Mean = 23.68 sec 
Standard Deviation = 3.76 sec 
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Figure 35. Motorola First Acguisition Time After 30 Minutes Off 
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Figure 36. Motorola First Acquisition Accuracy After 30 Minutes Off 
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Mean < 27.82 sec 
Standard Deviation = 7.50 sec 
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Figure 37. Motorola First Acguisition Time After 1 Hour Off 
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Figure 38. Motorola First Acquisition Accuracy After 1 Hour Off 
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Mean < 23.74 sec 
Standard Deviation < 5.99 sec 
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Figure 39. Motorola First Acquisition Time After 3 Hours Off 
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Figure 40. Motorola First Acquisition Accuracy After 3 Hours Off 
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Mean = 44.25 sec 
Standard Deviation = 2.91 sec 
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Figure 41. Motorola First Acquisition Time After 6 Hours Off 
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Figure 42. Motorola First Acquisition Accuracy After 6 Hours Off 
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Mean = 21.68 sec 
Standard Deviation = 2.09 sec 
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Figure 43. Motorola Time to First Fix After 90 Seconds Off 
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Figure 44. Motorola First Fix Accuracy After 90 Seconds Off 
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Mean x 23.86 sec 
Standard Deviation = 3.39 sec 
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Figure 45. Motorola Time to First Fix After 10 Minutes Off 
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Figure 46. Motorola First Fix Accuracy After 10 Minutes Off 
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Mean = 26.37 sec 
Standard Deviation = 6.10 sec 
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Figure 47. Motorola Time to First Fix After 30 Minutes Off 
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Figure 48. Motorola First Fix Accuracy After 30 Minutes Off 
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Mean = 34.13 sec 


Standard Deviation = 11.09 sec 





0 5 10 15 20 25 30 35 40 45 
Trial Number 


Figure 49. Motorola Time to First Fix After 1 Hour Off 
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Figure 50. Motorola First Fix Accuracy After 1 Hour Off 
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Mean < 36.0 sec 
Standard Deviation = 11.59 sec 
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Figure 51. Motorola Time to First Fix After 3 Hours Off 
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Figure 52. Motorola First Fix Accuracy After 3 Hours Off 
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Figure 53. Motorola Time to First Fix After 6 Hours Off 
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Figure 54. Motorola First Fix Accuracy After 6 Hours Off 
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APPENDIX D: GLOSSARY OF TERMS 


Data transmitted by a GPS satellite which includes orbit 
information on all the satellites, clock correction, and atmospheric 
delay parameters. These data are used to facilitate rapid satellite 
acquisition. The orbit information 1s a subset of the ephemeris data 
with reduced accuracy. 


A horizontal direction expressed as the angular distance between a 
fixed direction, such as North, and the direction of the object. 


The three-dimensional (3D) vector distance between a pair of 
stations for which simultaneous GPS data has been collected and 
processed with differential techniques. 


The Coarse/Acquisition (or Clear/Acquisition) code modulated 
onto the GPS L1 signal. This code is a sequence of 1023 
pseudorandom binary biphase modulations on the GPS carrier at a 
chipping rate of 1.023 MHz, thus having a code repetition period of 
one millisecond. This code was selected to provide good 
acquisition properties. 


Common LISP Object System 


Differential Processing GPS measurements can be differenced between receiver, 


satellites, and epochs. Although many combinations are possible, 
the present convention for differential processing of GPS phase 
measurements, is to take differences between receivers (single 
difference), then between satellite (double difference), then 
between measurement epochs (triple difference). A  single- 
difference measurement between receivers is the instantaneous 
difference in phase of the signal from the same satellite, measured 
by two receivers simultaneously. A double-difference measurement 
is obtained by differencing the single difference for one satellite 
with respect to the corresponding single difference for a chosen 
reference satellite. A  triple-difference measurement is the 
difference between a double difference at one epoch of time and the 
same double difference at the previous epoch of time. 


Differential (relative) Processing Determination of relative coordinates of two or 


more receivers which are simultaneously tracking the same 
satellites. Dynamic differential positioning is a real-time calibration 
technique achieved by sending corrections to the roving user from 
one or more monitor stations. Static differential GPS involves 
determining baseline vectors between pairs of receivers. 
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Dilution of Precision A description of the purely geometrical contribution to the 


Doppler Shift 


Elevation 


Ephemeris 


Epoch 


EEPROM 


EPROM 


GDOP 


GMT 


Inclination 


uncertainty in a position fix, given by the expression DOP < SORT 
TRACE (A A) where A A is the design matrix for the instantaneous 
position solution (dependent on satellite-receiver geometry). The 
DOP factor depends on the parameters of the position-fix solution. 
Standard terms for the GPS application are: 


GDOP: Geometric (three position coordinates plus clock offsetin 
the solution) 

PDOP: Position (three coordinates) 

GDOP: Horizontal (two horizontal coordinates) 

VDOP: Vertical (height only) 

TDOP: Time (clock offset only) 

RDOP: Relative (normalized to 60 seconds) 


The apparent change in freguency of a received signal due to the 
rate of change of the range between the transmitter and receiver. 


Height above mean sea level. Vertical distance above the geold. 


A list of accurate positions or locations of a celestial object as a 
function of time. Available as "broadcast ephemeris" or as post- 
processed "precise ephemeris”. 


Measurement interval or data frequency, as in making observations 
every 15 seconds. Loading data using 30-second epochs, means 
loading every other measurement. 


Electrically Erasable Programmable Read Only Memory, a random 
access memory device that is generally read but can be erased and 
rewritten electrically, often without removing it from its application 
system. 


Erasable Programmable Read Only Memory, a random access 
device in which individual words can be read but not written. An 
EPROM can be erased, often by irradiating it with ultraviolet light. 


Geometric Dilution of Precision. The relationship between errors in 
user position and time and in satellite range. GDOP? = PDOP? + 
TDOP? 


Greenwich Mean Time. Local solar mean time at Greenwich 
Meridian. 


The angle between the orbital plane of a body and some reference 
plane (e.g. equatorial plane). 
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INS 


Ralman Filter 


Kinematic Surveying 


LI 


L Band 


Inertial Navigation System, which contains an Inertial 
Measurement Unit (IMU). 


A numerical method used to track a time-varying signal in the 
presence of noise. If the signal can be characterized by some 
number of parameters that vary slowly with time, then Kalman 
filtering can be used to tell how incoming raw measurements 
should be processed to best estimate those parameters as a function 
of time. 


A form of continuous differential carrier-phase surveying reguiring 
only short periods of data observations. Operational constraints 
include starting from or determining a known baseline, and tracking 
a minimum of four satellites. One receiver is statically located at a 
control point, while others are moved between points to be 
measured. 


The primary L-band signal radiated by each NAVSTAR satellite at 
1575.42 MHz. The LI beacon is modulated with the C/A and P 
codes, and with the NAV message. L2 is centered at 1227.60 MHz 
and is modulated with the P code and the NAV message. 


The radio freguency band extending from 390 MHz to (nominally) 
1550 MHz. 


Multichannel ReceiverA receiver containing many independent channels. Such a receiver 


Multipath 


Multipath Error 


offers highest signal-to-noise ratio (SNR) because each channel 
tracks one satellite continuously. 


Interference similar to "ghosts" on a television screen which occurs 
when GPS signals arrive at an antenna having traversed different 
paths. The signal traversing the longer path will yield a larger 
pseudorange estimate and increase the error. Multiple paths may 
arise from reflections from structures near the antenna. 


A positioning error resulting from interference between radio 
waves which have traveled between the transmitter and the receiver 
by two paths of different electrical lengths. 


Multiplexing Channel A receiver channel which is sequenced through several satellite 


signals (each from a specific satellite and at a specific frequency) at 
a rate which is synchronous with the satellite message bit-rate (50 
bits per second, or 20 milliseconds per bit). Thus, one complete 
seguence is completed in a multiple of 20 milliseconds. 
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NAVDATA 


NAVSTAR 


PCMCIA 


PCB 


P Code 


PDOP 


RICE 


Point Positioning 


The 1500-bit Navigation Message broadcast by each satellite at 50 
bps on both Ll or L2 beacons. This message contains system time, 
clock correction parameters, ionospheric delay model parameters, 
and the vehicle's ephemeris and health. This information is used to 
process GPS signals to obtain user position and velocity. 


The name given to GPS satellites, built by Rockwell International, 
which is an acronym formed from NAViation System with Time 
and Ranging. 


PC Memory Card International Association, a voluntary association 
responsible for defining the electrical interface to and physical 
reguirements of memory and I/O modules that are approximately 
the size of a standard credit card. 


Printed Circuit Board 


The protected or precise code used on both LI and L2 GPS 
beacons. This code will be made available by the DoD only to 
authorized users. The P code is a very long (about 1074 Dits) 
seguence of pseudorandom binary biphase modulations on the GPS 
carrier at a chipping rate of 10.23 MHz which does not repeat itself 
for about 38 weeks. Each satellite uses a one-week segment of this 
code which is unigue to each GPS satellite, and is reset each week. 


Position Dilution of Precision, a unitless figure of merit expressing 
the relationship between the error in user position and the error in 
satellite position. Geometrically, PDOP is proportional to 1 divided 
by the volume of the pyramid formed by lines running from the 
receiver to four satellites observed. Values considered good for 
positioning are small, such as 3. Values greater than 7 are 
considered good for positioning are small, such as 3. Values greater 
than 7 are considered poor. Thus, small PDOP is associated with 
widely separated satellites. A small value of PDOP is important in 
positioning, but much less so in surveying. 


Plastic Leadless Chip Carrier, a high-density, integrated circuit 
package designed to fit in a socket for easy installation and 
removal. 


A geographic position produced from one receiver in a stand-alone 
mode. At best, position accuracy obtained from a stand-alone 
receiver is 15 - 25 meters, depending on the geometry of the 
satellites. 
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PPS 


PRN 


Pseudorange 


ROM 


RDOP 
RMS 


Precise Positioning Service. The highest level of military dynamic 
positioning accuracy that vvill be provided by GPS, based on the 
dual frequency P code and having high anti-jam and anti-spoof 
qualities. 


Pseudorandom noise, a sequence of digital 1s and Os which appear 
to be randomly distributed like noise, but which can be exactly 
reproduced. The important property of PRN codes is that they have 
a low autocorrelation value for all delays or lags except when they 
are exactly coincident. Each NAVSTAR satellite has 1ts own unique 
C/A and P pseudorandom-noise codes. 


A measure of the apparent propagation time from the satellite to the 
receiver antenna, expressed as a distance. Pseudorange is obtained 
by multiplying the apparent signal-propagation time by the speed of 
light. Pseudorange differs from the actual range by the amount that 
the satellite and user clocks are offset, by propagation delays, and 
other errors. The apparent propagation time is determined from the 
time shift required to align (correlate) a replica of the GPS code 
generated in the receiver with the received GPS code. The time 
shift is the difference between the time of signal reception 
(measured in the receiver time frame) and the time of emission 
(measured in the satellite time frame). 


Random Access Memory, a memory that can conveniently read 
from and write to any location. Random access memory contrasts 
with sequential access memory which can access only one location 
without repositioning a read/write head. Although there are other 
random-access devices (such as an EPROM), the acronym RAM 
refers only to devices that can read and write a single location at a 
time. 


Read Only Memory, a random access memory that can be read but 
not written. Data in a ROM is either built into the ROM when it is 
manufactured or is written into the ROM in a once-only operation 
called programming. Devices that can be programmed are more 
properly called PROMs. 


Relative Dilution of Precision. See Dilution of Precision. 


Root Mean Sguare. 
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SA 


SEP 


Sidereal Day 


Spread Spectrum 


SPS 


TDOP 
TOW 
UL 
VDOP 


Selective Availability. A DoD program to control the accuracy of 
pseudorange measurements, whereby the user receives a false 
pseudorange which is in error by a controlled amount. Differential 
GPS technigues can reduce these effects for local applications. 


Spherical Error Probable, a statistical measure of precision defined 
as the 50th percentile value of the three-dimensional position error 
statistics. Thus, half of the results are within a 3D DEP value. 


Time between two successive upper transits of the vernal eguinox. 


The received GPS signal is a wide bandwidth, low-power signal (- 
160 dBW). This property results from modulating the L-band signal 
with a PRN code in order to spread the signal energy over a 
bandwidth which is much greater than the signal information 
bandwidth. This is done to provide the ability to receive all 
satellites unambiguously and to provide some resistance to noise 
and multipath. 


Standard Positioning Service, using the C/A code to provide a 
minimum level of dynamic or static positioning capability. The 
accuracy of this service will be set at a level consistent with 
national security. 


Time Dilution of Precision. See Dilution of Precision. 
Time of Week, in seconds from midnight Sunday UTC. 
Universal Time. Local solar mean time at Greenwich Meridian. 


Vertical Dilution of Precision. See Dilution of Precision. 
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